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本 书 从 工业 机 器 人 应 用 实际 出 发 ， 以 工业 机 器 人 工作 站 的 全 局 为 视 
角 ， 介 绍 工业 机 器 人 的 相关 技术 。 全 书 共 分 为 十 一 章 ， 包 括 走 近 工 业 机 器 
人 、 工 业 机 器 人 的 组 成 及 工作 原理 、 工 业 机 器 人 运动 学 、 工 业 机 器 人 动力 
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及 仿真 、 工 业 机 器 人 工作 站 及 生产 线 、 工 业 机 器 人 工作 站 的 维护 、 工 业 机 
器 人 的 安全 防护 、 工 业 机 融 人 的 发 展 趋势 。 

本 书 由 浅 入 深 ， 从 机 器 人 技术 的 基础 出 发 ,涉及 机 器 人 的 操作 、 日 常 
维护 检修 、 安 全 使 用 等 各 个 方面 ， 实 用 性 强 ， 可 作为 高 职高 专机 电 类 专业 
的 教材 和 相近 专业 的 本 科教 材 ， 同 时 也 可 作为 专业 技术 人 员 的 参考 用 书 。 

本 书 配 有 电子 课件 ， 凡 使 用 本 书 作为 教材 的 教师 可 登录 机 械 工业 出 版 
社 教 育 服 务 网 www. cmpedu. com 下 载 。 咨 询 邮 箱 : cmpgaozhi@ sina. com。 
咨询 电话 : 010-88379375 。 
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在 机 器 人 技术 快速 发 展 的 今天 ， 工 业 机 器 人 在 世界 范围 内 的 产销 量 及 安装 量 都 在 迅速 
增长 ， 特 别 是 在 汽车 制造 业 ， 机 器 人 越 来 越 多 地 取代 人 工 操 作 ， 使 汽车 生产 的 自动 化 水 平 
远 远 高 于 其 他 行业 。 随 之 而 来 的 ， 是 对 机 器 人 使 用 与 维护 人 才 的 大 量 需 求 。 为 适应 企业 的 
需要 ， 各 高 职高 专 学 校 纷纷 开设 机 器 人 课程 并 布 望 有 配套 的 教学 用 书 。 本 书 是 编者 在 多 年 
机 器 人 课程 教学 的 基础 上 与 企业 机 器 人 相关 技术 人 员 合 作 完 成 的 。 本 书 以 真实 的 企业 机 器 
人 工作 站 、 教 学 实 训 机 器 人 工作 站 为 实例 ， 由 浅 入 深 ， 注 重 理论 与 实践 相 结 合 ， 涉 及 机 器 
人 机 械 结 构 、 控 制 系统 、 传 感 系统 、 示 教 编程 、 维 护 检修 的 各 个 方面 ， 但 又 不 仅 限 于 机 器 
人 本 身 ， 还 涉及 机 器 人 周边 的 设备 与 机 器 人 的 联系 ， 把 机 器 人 作为 了 一 个 自动 化 系统 中 的 
= 

机 器 人 技术 是 多 学 科技 术 的 融合 ， 涉 及 机 械 、 电 子 、 计 算 机 、 自 动 控制 、 人 工 智 能 
等 多 个 学 科 ， 书 中 尽 可 能 多 地 将 涉及 的 学 科技 术 进行 阐述 ， 在 机 器 人 的 本 体 结构 中 可 以 
学 到 机 械 原 理 的 应 用 ,在 机 器 人 的 控制 中 可 以 学 习 控 制 理论 的 应 用 ,在 机 器 人 传感器 技 
术 中 可 以 学 到 电子 技术 的 应 用 ， 在 机 器 人 的 伺服 控制 中 可 以 学 到 电动 机 控制 方法 的 应 
用 ， 在 机 器 人 工作 站 中 可 以 学 到 PLC 及 总 线 技术 的 应 用 ， 在 机 器 人 的 编程 操作 中 可 以 学 
到 计算 机 技术 的 应 用 。 

本 书 的 特点 是 理论 深度 适当 ， 注 重 实 际 应 用 ， 易 读 易 懂 ， 全 方位 介绍 机 器 人 相关 知 
识 与 应 用 技术 。 

本 书 由 陈 溪 游 、 陈 彬 任 主 编 ， 管 小 清 、 吕 世 霞 任 副 主编 ， 王 刚 任 主 审 。 第 一 章 、 第 
二 章 、 第 八 章 由 陈 彬 编写 ， 第 三 章 、 第 四 章 由 管 小 清 编写 ， 第 五 章 、 第 七 章 由 陈 溪 游 纺 
写 ， 第 六 章 、 第 十 章 由 吕 世 起 编写 ， 第 九 章 由 韩鹏 编写 ， 第 十 一 章 由 叶 晖 编写 。 

本 书 在 编写 过 程 中 ， 参 考 和 引用 了 大 量 的 有 关机 器 人 的 论著 、 资 料 ， 包 括 KUKA 机 
器 人 、MOTOMAN 机 器 人 的 操作 手册 等 ， 由 于 篇 幅 有 限 ， 不 能 在 文中 一 一 列举 ， 感 谢 奔 
驰 公 司 、ABB 公司 、KUKA 公司 技术 人 员 的 技术 指导 。 由 于 水 平 有 限 ， 书 中 难免 会 有 错 
误 和 不 足 之 处 ， 尽 请 读者 给 予 批评 指正 。 
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工业 机 带 人 是 机 各 人 家 族 中 的 一 员 ， 所 请 “机 带 人 ”到 目前 为 止 还 没有 非常 确切 的 定 
义 ， 机 船 人 问世 已 有 相当 长 的 历史 ， 但 对 机 顺 人 的 定义 却 没有 一 个 统一 的 意见 。 原 因 之 一 是 
机 器 人 还 在 发 展 ， 新 的 机 型 、 新 的 功能 不 断 涌 现 ， 而 且 机 器 人 涉及 人 的 概念 ， 成 为 一 个 难以 
回答 的 哲学 问题 。 也 许 正 是 由 于 机 硕 人 定义 的 模 精 ， 才 给 了 人 们 充分 的 想象 和 创造 空间 。 

概括 地 说 ， 机 豆 人 《Robot) 是 目 动 进行 工作 的 机 豆 装 置 。 它 可 以 是 各 种 样子 ， 并 不 一 
定 长 得 像 人 ， 也 不 见得 以 人 类 的 动作 方式 活动 。 它 既 可 以 接受 人 类 指挥 ， 又 可 以 运行 预先 编 
排 的 程序 ， 也 可 以 根据 以 人 工 智 能 技术 制定 的 原则 、 纲 领 行动 。 它 的 任务 是 协助 或 取代 人 类 
的 工作 ， 例 如 生产 加 工 、 建 筑 作 业 ， 或 是 危险 性 大 的 工作 。 


第 一 卫 _ 机 描 人 的 发 展 历 程 


人 类 对 机 融 人 的 幻想 与 追求 已 有 3000 多 年 的 历史 。 据 史料 记载 ， 早 在 西周 时 期 ， 中 国 
就 已 出 现 能 歌 善 舞 的 伶 人 机 需 人 。 古 代 机 需 人 不 仅 精巧 ， 用 途 也 很 广泛 。 主 人 用 滴漏 计时 的 
方法 ， 其 实 就 是 一 种 目 动 化 计时 设备 一 一 水 钟 。 水 钟 是 用 两 个 水 壶 一 上 一 下 放置 ， 上 面 的 水 
壶 将 水 滴 到 下 面 的 水 壶 里 。 下 面 的 水 壶 中 安放 一 个 泽 标 ， 浮 标 劳 有 表示 时 间 的 刻度 。 这 样 ， 
浮标 随 痢 水 位 的 升 高 而 升 起 ， 人 们 就 会 通过 浮标 的 位 置 知 道 时 间 。 

据 《 墨 经 》 记 载 ， 春 秋 后 期 ， 我 国 闭 名 的 工匠 鲁班 ， 曾 制造 过 一 只 木马， 能 在 空中 发 
"Hk 

公元 前 2 世纪 ， 亚 历 山 大 时 代 的 古 硕 腊 人 发 明了 最 原始 的 机 磊 人 一 一 自动 机 。 它 是 以 
水 、 空 气 和 藻 汽 压力 为 动力 的 会 动 的 雕像 ， 它 可 以 自己 开门 ， 还 可 以 借助 落 汽 唱歌 。 

1800 年 前 的 汉代 ， 大 科学 家 张衡 不 仅 发 明了 地 动 仪 ， 而 且 发 明了 计 里 或 车 。 计 里 误 车 
每 行 一 里 > 车 上 术 人 击 或 一 下 ,每 行 十 里 击 促 一 下 % 

后 汉 三 国 时 期 ， 罚 国 孙 相 诸 询 完 成 功 地 创造 出 了 “ 木 牛 流 马 ”， 并 用 其 运送 军粮 ， 支 援 
前 方 战争 。 

1662 年 ,日 本 的 竹田 近江 利用 钟表 技术 发 明了 自动 机 带 玩 偶 ， 并 在 大 阪 的 道 顿 韧 演 
现在 保留 下 来 的 最 早 机 各 人 是 瑞士 努 楷 带 尔 历史 博物 馆 里 的 少女 玩偶 ， 它 制作 于 200 年 

前 ， 两 只 手 的 10 个 手指 可 以 按 动 风 花 的 琴键 而 弹 奏 音乐 ， 现 在 还 定期 演奏 供 参 观 者 欣 

现代 机 融 人 的 研究 始 于 20 世纪 中 期 ， 其 技术 背景 是 计算 机 和 上 自动 化 的 发 展 ， 以 及 原子 
能 的 开发 利用 。 
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1927 年 美国 西屋 公司 工程 师 温 效 利 制造 了 第 一 个 机 项 人 “电报 箱 ”， 并 在 纽约 举行 的 世 
界 博 览 会 上 展 出 。 它 是 一 个 电动 机 融 人 ， 装 有 无 线 电 发 报 机 ， 可 以 回答 一 些 问 题 ， 但 该 机 器 
人 不 能 走动 。 

1947 年 ， 美 国 原子 能 委员 会 的 阿尔 贡 人 研究 所 开发 了 遥控 机 械 手 ， 以 代替 人 处 理 放 射 性 
物质 。1948 年 又 开发 了 机 械 式 的 主 从 机 械 手 。 

1954 年 美国 戴 沃 尔 最 早 提出 了 工业 机 器 人 的 概念 ， 并 申请 了 专利 。 该 专利 的 要 点 是 借 
助 伺服 技术 控制 机 项 人 的 关节 ， 利 用 人 手 对 机 融 人 进行 动作 示 教 ， 机 器 人 能 实现 动作 的 记录 
和 再 现 ， 这 就 是 所 谓 的 示 教 再 现 机 器 人 。 现 有 的 机 器 人 差不多 都 采用 这 种 控制 方式 。 

1959 年 第 一 台 工 业 机 器 人 【可 编程 、 圆 坐标 ) 在 美国 诞生 ， 开 创 了 机 器 人 发 展 的 新 纪 
风 o 

1962 年 美国 AMF 公司 推出 了 “VERSTRAN” 机 器 人 和 UNIMATION 公司 推出 了 “UNT- 
MATE” 机 器 人 。 这 些 工业 机 器 人 的 控制 方式 与 数控 机 床 大 致 相似 ， 但 外 形 特 征 迎 异 ， 主 要 
由 类 似 人 的 手 和 臂 组 成 。 

1965 年 ，MIT 的 Roborts 演示 了 第 一 个 具有 视觉 传 感 咒 的 、 能 识别 与 定位 简单 积木 的 机 
硕 人 系统 。 

1967 年 日 本 成 立 了 人 工 手 研究 会 〈 现 改名 为 仿生 机 构 人 研究 会 ) ， 同 年 召开 了 日 本 首届 机 
硕 人 学 术 会 议 。 

1970 年 在 美国 召开 了 第 一 届 国 际 工 业 机 器 人 学 术 会 议 。1970 年 以 后 ， 机 器 人 的 研究 得 
到 迅速 广泛 的 普及 。 

1973 年 ， 洗 阐 那 提 “' 米 拉克 隆 公 司 的 理 查 德 . 肾 恩 制造 了 第 一 台 由 小 型 计算 机 控制 的 
工业 机 器 人 ， 它 是 液压 驱动 的 ， 能 提升 的 有 效 负 载 达 45kg。 

1980 年 ， 工 业 机 需 人 在 日 本 得 到 了 巨大 发 展 ， 日 本 也 因此 而 记得 了 “机 赤 人 王国 ”的 
美称 。 

随 着 计算 机 技术 和 人 工 智 能 技术 的 飞速 发 展 ， 机 需 人 在 功能 和 技术 层次 上 有 了 很 大 的 提 
高 ， 移 动机 器 人 和 机 顺 人 的 视觉 、 触 觉 等 技术 就 是 典型 的 代表 。 由 于 这 些 技术 的 发 展 ， 推 动 
了 机 需 人 概念 的 延伸 。20 世纪 80 年 代 ， 将 具有 感觉 、 思 考 、 诀 策 和 动作 能 力 的 系统 称 为 智 
能 机 各 人 ， 这 是 一 个 概括 的 、 含 义 广泛 的 概念 。 这 一 概念 不 但 指导 了 机 器 人 技术 的 研究 和 应 
用 ， 而且 赋予 了 机 各 人 技术 问 纵 深发展 的 巨大 空间 ， 水 下 机 各 人 、 空 间 机 各 人 、 空 中 机 玫 
人 人、 地面 机 融 人 、 微 小 型 机 需 人 等 各 种 用 途 的 机 需 人 相继 问世 ， 许 多 梦想 成 为 现实 。 将 机 器 
人 的 技术 〈 如 传 感 技术 、 智 能 技术 、 控 制 技术 等 ) 扩散 和 渗透 到 各 个 领域 ， 形 成 了 各 式 各 
样 的 机 絮 人 化 机 絮 。 当 前 与 信息 技术 的 交互 和 融合 又 产生 了 “软件 机 器 人 ”“ 网 络 机 器 人 ” 
的 名 称 ， 这 也 说 明了 机 各 人 所 具有 的 创新 活力 。 


第 一 证 机 高 人 的 分 类 


机 釉 人 按照 应 用 领域 的 不 同 ， 可 以 分 为 主要 用 于 军事 领域 的 排 雷 机 天 人 人、 装甲 机 需 人 、 
无 人 机 等 ; 用 于 科学 探索 的 空间 机 舌 人 、 登 月 机 适 人 、 水 下 机 需 人 ; 用 于 医学 领域 的 手术 机 
信人; 用 于 娱乐 的 舞蹈 机 右 人 、 弹 答 机 右 人 、 玩 具 机 旧 人 ; 用 于 为 人 类 服务 的 服务 机 符 人 、 
尽 调 机 和 融 人 、 管 违 清洁 机 帮 人 ; 用 于 农业 生产 的 采摘 机 需 人 ;， 用 于 工业 生产 的 工业 机 奉 人 ; 
































第 三 章 走 过 工 业 机 器 人 / 


用 于 科学 人 研究 的 仿生 机 需 人 等 。 
本 书 主要 人 研究 对 象 为 工业 机 右 人 ， 现 对 工业 机 各 人 的 常见 类 型 加 以 介绍 。 


一 、 工 业 机 器 人 按照 驱动 方式 分 类 


1. 气动 式 

机 器 人 的 动力 来 源 于 压缩 空气 ， 气 拭 作为 执行 机 构 。 这 种 形式 的 优点 是 气 源 方便 ， 动 作 
和 迅速， 结构 简单 ， 造 价 低 ， 维 修 方便 。 缺 点 是 空气 具有 可 压缩 性 ， 致 使 工作 速度 难以 控制 。 
因 气 源 压力 一 般 只 有 60MPa 左右 ， 故 此 类 机 器 人 适宜 抓举 力 要 求 较 小 的 场合 。 

2. 液 动 式 

机 器 人 的 动力 来 源 于 液压 缸 或 液压 马达 ， 相 对 气动 式 ， 液 压 式 有 较 大 的 抓举 力 ， 可 以 达 
到 几 百 千 殉 ,并 且 结 构 紧 竣 、 传 动 平 稳 、 耐 冲击 、 耐 振动 、 动 作 灵 敏 、 防 爆 性 好 ， 但 对 密封 
的 要 求 和 制造 精度 较 高 ， 因 而 成 本 较 高 ， 且 不 宜 在 高 温 或 低温 的 场合 工作 。 

3. 电动 式 

用 电力 驱动 有 更 多 的 优越 性 ,不 只 是 电源 方便 ,不 污染 环境 ， 而 且 驱 动力 大 ， 可 达到 
400kg， 更 突出 的 优点 是 电力 驱动 可 以 采用 多 种 灵活 的 控制 方式 ， 运 动 精 度 高 、 成 本 低 、 驱 
动 效 率 高 ， 并 且 信 号 检测 、 传 递 、 处 理 方便 ， 因 此 是 应 用 最 为 广泛 的 一 种 驱动 方式 。 电 力 驱 
动 可 分 为 步 进 电 动机 驱动 、 直 流 伺服 电 动机 驱动 、 无 刷 伺 服 电动 机 驱动 等 。 另 外 ， 还 有 混合 
驱动 方式 ， 如 液 - 气 或 电 - 液 混合 驱动 。 


二 、 工 业 机 器 人 按照 用 途 分 类 



































1. 焊接 机 器 人 

工业 机 大 人 最 大 的 应 用 领域 是 汽车 制造 行业 ， 在 汽车 制造 行业 中 应 用 最 多 的 是 焊接 机 各 
人 ， 焊 接 机 器 人 还 可 以 分 为 弧 焊 机 絮 人 和 点 焊 机 器 人 两 种 。 弧 焊 机 右 人 负 葡 为 焊 枪 ， 因 此 较 
点 焊 机 絮 人 的 负 春 轻 ， 速 度 低 ， 但 对 运动 轨迹 要 求 严 ， 运 动 轨迹 的 每 一 点 都 要 按 预 定 的 姿态 
和 位 置 移动 。 点 焊 机 器 人 负 答 大 ， 因 为 点 焊 的 焊 钳 重量 较 大 ， 一般 达 上 百 公 斤 ， 动 作 快 ， 工 
作 点 的 姿态 和 位 置 要 求 严格 。 

2. 搬运 机 器 人 

搬运 机 器 人 的 应 用 范围 很 广 ， 在 各 个 行业 都 有 应 用 ， 搬 运 机 器 人 的 运动 轨迹 要 求 不 高 ， 
但 对 搬运 起 点 和 终点 的 位 置 及 姿态 要 求 严 格 。 多 数 用 于 上 下 料 ， 如 在 汽车 冲压 生产 线 中 ， 搬 
运 机 需 人 用 于 拆 埃及 冲压 机 的 上 下 料 ， 有 时 也 用 于 工件 的 持 握 。 

3. 喷涂 机 器 人 

哎 涂 机 器 人 一 般 用 于 噶 漆 作业 ， 在 汽车 生产 中 还 用 于 涂 股 作业， 特点 是 负 和 丛 轻 、 速 度 
慢 ， 用 于 涂 胶 时 对 运动 轨迹 要 求 严 格 。 由 于 漆 筋 易 燃 ， 一 般 采 用 液压 驱动 或 伺服 电动 机 豫 
Sls 

4. 装配 机 器 人 

装配 机 器 人 多 用 于 机 电 产 品 的 装配 作业 ， 一 般 自 由 度 在 5 以 下 ， 手 腕 要 求 具有 和 较 好 的 邓 
性 ， 位 置 精度 要 求 较 高 ， 速 度 快 。 
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三 、 工 业 机 器 人 按照 运动 关节 的 数量 分 类 


4 轴 (4 自由 度 )、5 轴 (5 自由 度 )、6 轴 (6 自由 度 ) 和 7 轴 (7 自由 度 ) 秆 机 胡 人 ， 
机 带 人 的 轴 数 越 多 ,说明 它 的 灵活 性 越 好 ， 工 作 能 力也 越 强 。 机 右 人 的 自由 度 也 是 重要 的 机 
信人 技术 参数 。 


四 、 工 业 机 器 人 按照 发 展 程度 分 类 


1. 第 一 代 机 器 人 

第 一 代 机 器 人 主要 指 只 能 以 示 教 -再 现 方式 工作 的 工业 机 器 人 ， 称 为 示 教 -再 现 型 。 所 谓 
示 教 ， 即 由 人 教 机 需 人 运动 的 轨迹 、 停 留 点 位 、 停 留 时 间 等 。 然 后 ， 机 器 人 依照 教 给 的 行 
为 、 顺 序 和 速度 重复 运动 ， 即 所 谓 的 再 现 。 示 教 可 由 操作 员 通 过 控制 面板 完成 ， 操 作 人 员 利 
用 控制 面板 上 的 开关 或 键盘 控制 机 器 人 一 步 一 步 地 运动 ， 机 器 人 以 程序 的 形式 记录 下 每 一 步 
动作 的 轨迹 、 速 度 、 姿 态 ， 然 后 重复 实现 示 教 的 动作 。 目 前 在 工业 现场 应 用 的 机 器 人 大 多 采 
用 这 一 太志 

2. 第 二 代 机 器 人 

第 二 代 机 器 人 带 有 一 些 可 感知 环境 的 装置 ， 通 过 反馈 控制 ， 使 机 器 人 能 在 一 定 程度 上 适 
应 变化 的 环境 。 这 样 的 技术 现在 正 越 来 越 多 地 应 用 在 机 器 人 上 ， 如 焊 缝 跟踪 技术 。 在 机 器 人 
焊接 的 过 程 中 ， 一 般 通 过 示 教 方式 给 出 机 器 人 的 运动 曲线 ， 机 器 人 携带 焊 枪 沿 着 这 条 曲线 进 
行 焊接 。 这 就 要 求 工 件 的 一 致 性 好 ， 也 就 是 说 工件 被 焊接 的 位 置 必须 十 分 准确 ， 和 否则 ， 机 需 
人 行走 的 曲线 和 工件 上 实际 焊 颖 位置 将 产生 偏差 。 焊 颖 跟踪 技术 是 在 机 各 人 上 加 一 个 传 感 
器 ， 通 过 传 感 硕 感知 焊 颖 的 位 置 ， 再 通过 反 锯 控制 ， 机 硕 人 目 动 跟 踩 焊 缝 ， 从 而 对 示 教 的 位 
置 进行 修 正 。 即 使 实际 焊 颖 相对 于 原始 设 定 的 位 置 有 变化 ， 机 器 人 仍然 可 以 很 好 地 完成 焊接 
Ts 

3. 第 三 代 机 器 人 

第 三 代 机 器 人 是 智能 机 器 人 ， 它 具有 多 种 感知 功能 ， 可 进行 复杂 的 逻辑 推理 、 判 断 及 决 
琐 ， 可 在 作业 环境 中 独立 行动 ; 它 具 有 发 现 问题 且 能 自主 地 解决 问题 的 能 

这 类 机 器 人 带 有 多 种 传 感 硕 ， 使 机 器 人 可 以 知道 其 自身 的 状态 ， 例 如 在 什么 位 置 ， 自 身 
的 系统 是 和 否 有 故障 等 ;， 且 可 通过 装 在 机 需 人 喘 上 或 者 工作 环境 中 的 传 感 右 感 知 外 部 的 状态 ， 
例如 发 现 道路 与 危险 地 段 ， 测 出 与 协作 机 器 的 相对 位 置 与 距离 以 及 相互 作用 的 力 等 。 机 需 人 
能 够 根据 得 到 的 这 些 信息 进行 逻辑 推理 、 判 断 、 决 策 ， 在 变化 的 内 部 状态 与 外 部 环境 中 ， 自 
主 决定 自身 的 行为 。 这 类 机 器 人 具有 高 度 的 适应 性 和 自治 能 力 ， 这 是 人 们 努力 使 机 器 人 达到 
的 日 标 。 经 过 科学 家 多 年 来 不 懈 的 研究 ， 已 经 出 现 了 很 多 各 具 特 点 的 试验 装置 和 大 量 的 新 方 
法 、 新 思想 。 但 是 ， 在 已 应 用 的 机 器 人 中 ， 机 器 人 的 自 适应 技术 仍 十 分 有 限 ， 该 技术 是 机 唤 
人 今后 发 展 的 方向 。 





















































第 三 加 工业 机 高 人 的 应 用 现状 
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工业 机 和 右 人 的 应 用 数量 在 逐年 增加 ， 据 IFR (国际 机 右 人 联合 会 ) 的 统计 (图 1-1)， 


第 一 章 ” 走 近 工 业 机 器 人 A 


全 球 工业 机 器 人 的 年 新 安装 数量 2006 年 为 111052 台 ，2007 年 为 114365 台 ，2008 年 为 
118900 台 。 全 球 工 业 机 器 人 的 累积 安装 量 2007 年 为 994005 台 ，2008 年 为 1035900 台 。IFR 
的 统计 还 表明 ， 我 国 工 业 机 器 人 的 年 新 安装 数量 2006 年 为 5570 台 ，2007 年 为 6581 台 ， 
2008 年 为 7500 台 。 
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图 1-1 1994 ~2012 年 度 全 球 工业 机 融 人 销售 数据 统计 


在 亚洲 ，2007 年 新 安装 的 机 顺 人 台数 达到 61000 台 。 在 欧洲 ，2007 年 机 各 人 的 销售 量 
大 约 34600 台 ， 增 长 10% ， 这 是 自从 工业 机 器 人 诞生 以 来 年 度 最 大 销量 。 德 国 是 欧洲 最 大 
的 工业 机 器 人 市 场 ， 达 到 14800 台 ， 增 长 29% ， 中 欧 和 东欧 国家 的 销量 也 达到 了 56% 的 增 
长 幅度 。 

据悉 ， 截 止 到 2009 年 底 ， 美 国运 行 中 的 工业 机 器 人 大 约 有 19.4 万 台 。 日 本 运行 中 的 工 
业 机 器 人 为 33. 98 万 台 ， 德国 14. 58 万 台 ， 韩 国 7.93 万 台 ， 意 大 利 6.29 万 台 ， 中 国 3. 68 

万 台 ， 印 度 0. 42 万 台 

由 于 金融 危机 区 影响 ， 2009 年 运行 中 的 工业 机 器 人 比 2008 年 下 降 了 0.5% 。 随 着 经 济 
逐步 恢复 ，2010 年 开始 恢复 性 增长 。 据 2013 年 IFR 发 表 的 最 新 统计 数据 ，2011 年 机 人 禹 人 销 
售 数量 比 2010 年 增长 了 38% ，2012 年 工业 机 右 人 的 销量 创 出 历史 第 二 高 ， 总 销售 量 超过 
159000 人 台 ， 仅 比 2011 年 的 历史 最 高 销量 略微 下 降 4% 。2008 ~ 2012 年 期 间 ， 机 器 人 的 年 均 
销售 增长 率 高 达 9% 。 

2012 年 ， 全 球 汽车 工业 的 机 带 人 购买 量 继续 上 升 (图 12)， 增幅 为 6%。 化 学 和 橡胶 

业 、 塑 料 工 业 以 及 食品 工业 的 机 各 人 订购 量 都 开始 升 高 ， 而 金属 加 工业 和 机 床 工业 的 订购 
则 略 有 减少 。 

随 痢 工业 机 需 人 应 用 的 范围 及 数量 不 断 增 长 ， 也 涌现 出 一 批 在 国际 上 较 有 影 啊 力 的 、 著 
名 的 工业 机 器 人 公司 。 如 瑞士 的 ABB Robotics， 德国 的 KUKA Roboter, 日 本 的 FANUC、 
Yaskawa ( 安 川 ) ， 美 国 的 Adept Technology、American Robot 、Emerson Industrial Automation 、 
S-T Robotics ， 意 大 利 的 COMAU ( 柯 马 ) ， 英 国 的 AutoTech Robotics， 加 拿 大 的 Jcd Interna- 
tional Robotics ， 以 色 列 的 Robogroup Tek 公司 ， 这 些 公司 已 经 成 为 其 所 在 地 区 的 支柱 性 企业 。 
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图 12 2010 ~2012 年 度 工业 机 器 人 在 各 行业 供应 量 统计 


在 国内 ， 工 业 机 大人 产业 起 步 较 晚 ， 但 增长 的 势头 非常 强劲 。 比 较 有 实力 的 公司 有 首钢 莫 托 
受 机 华人 有 限 公 司 ， 新 松 机 带 人 目 动 化 股份 有 限 公司 。 

首钢 莫 托 曼 机 天 人 有 限 公 司 由 中 国 首 钢 总 公司 、 日 本 株式 会 社 安 川 电机 和 日 本 岩 谷 产业 
株式 会 社 共同 投资 组 建 ， 主 营 日 本 安 川 MOTOMAN 系列 机 需 人 产品 ,广泛 应 用 于 弧 焊 、 点 
焊 、 涂 股 、 切 割 、 搬 运 、 码 过 、 顺 漆 、 科 人 研 及 教学 。 

新 松 机 各 人 自动 化 股份 有 限 公司 是 由 中 国 科 学 院 沈 阳 上 自动 化 研究 所 为 主 发 起 人 投资 组 建 
的 高 技术 公司 ,是 “机 和 带 人 国家 工程 研究 中 心 ”“ 国 家 八 六 三 计划 稼 能 机 带 人 主题 产业 化 基 
地 ”"， 是 一 家 以 先进 制造 技术 为 核心 ,拥有 自主 知识 产权 和 核心 技术 的 高 科技 企业 。 公 司 自 
2000 年 成 立 到 现在 ， 已 成 为 中 国 最 大 的 机 需 人 产业 化 基地 。 目 主 研发 了 中 国 第 一 台 工 业 机 
船 人 样机 、 中 国 第 一 台 AGV 上 自动 导 引 和 车、 中国 第 一 台 焊 接 机 和 硕 人 、 中 国 第 一 合 清 闪 〈 真 
空 ) 机 需 人 、 中 国 第 一 台 政 务 机 需 人 ， 国 产 机 盏 人 实现 批量 出 口 ， 填 补 了 国内 空白 ， 在 中 
国 机 融 人 发 展 史 上 留 下 了 将 煜 灿烂 的 一 页 。 其 产品 包括 RH6 弧 焊 机 豆 人 ，RD120 点 焊 机 天 
人 及 水 切割 、 激 光 加 工 、 排 险 、 浇 注 等 特种 机 带 人 。 

















第 一 节 ”工业 机 器 人 的 组 成 
机 器 人 一 般 由 三 大 部 分 六 个 子 系统 组 成 ， 这 三 部 分 是 机 械 部 分 、 传 感 部 分 和 控制 部 分 。 


六 个 子 系统 是 机 械 系统 、 驱 动 系统 、 控 制 系 统 、 人 机 交互 系统 、 感 知 系统 、 机 各 人 -环境 交 
互 系 统 ， 如 图 2-1 所 示 。 


人 机 交互 系 
茵 控制 部 分 


一 -| 


二 机 械 部 分 


























图 2-1 工业 机 震 人 组 成 


1. 机 械 部 分 

机 械 部 分 是 机 器 人 的 本 体 结构 及 驱动 装置 ， 相 当 于 人 体 的 躯干 和 手臂 ， 以 及 各 个 关节 ， 
是 机 器 人 动作 的 主体 ， 了 驱动 系统 可 以 是 液压 、 人 气动、 电动 传动 ， 或 者 把 它们 结合 起 来 应 用 的 
综合 系统 。 

2. 传 感 部 分 

机 顺 人 的 动作 都 是 受 控 的 ， OD ee 
置 、 速 度 、 和 角度、 力度 等 信息 反馈 给 控制 器 ， 通 过 人 机 交互 系统 使 操作 人 员 参 与 机 器 人 控 
i et et Na 
系 和 协调 ， 使 之 达到 控制 要 求 。 

3. 控制 部 分 

控制 部 分 是 机 需 人 的 大 脑 ， 它 根据 机 需 人 的 作业 指令 程序 以 及 从 传感器 反 饥 回来 的 信和 号 

















NN Tm A 


来 指挥 机 侣 人 的 动作 ， 完 成 人 类 交 给 机 旧 人 的 工作 。 
本 章 主 要 介绍 机 佛 人 的 机 械 部 分 和 传 感 部 分 ， 有 关 控 制 部 分 的 内 容 见 第 五 草 “ 工 业 机 
入 人 的 控制 ”。 





第 二 节 工业 机 器 人 的 机 械 系 统 
工业 机 各 人 的 机 械 结构 系统 是 指 其 本 体 结构 和 机 械 传动 系统 ， 也 是 机 各 人 的 支撑 基础 和 
执行 机 构 ， 大 致 分 为 机 里 、 手 臂 、 末 端 执行 副 几 部 分 ， 这 些 部 分 之 间 以 关 市 相连 接 ， 彼 此 之 
间 可 以 产生 相对 运动 。 
机 禹 人 本 体 结构 (图 2-2) 是 机 右 人 的 重要 部 分 ， 所 有 的 计算 、 分 析 和 编程 最 终 要 通过 
本 体 的 运动 和 动作 完成 特定 的 任务 。 机 絮 人 本 体 各 部 分 的 基本 结构 、 材 料 的 选择 将 直接 影响 
整体 性 能 。 











图 2-2 ”机 顺 人 本 体 结构 


一 、 机 器 人 本 体 结构 的 组 成 


由 于 应 用 场合 不 同 ， 机 和 右 人 结构 形式 多 种 多 样 ， 各 组 成 部 分 的 驱动 方式 、 传 动 原理 和 机 
械 结构 也 有 各 种 类 型 。 通 常 根据 机 侣 人 各 部 分 的 功能 ， 其 机 械 部 分 主要 由 下 列 各 部 分 组 成 。 

(一 ) 机 身 

机 号 又 称 立柱 ， 是 直接 连接 、 文 撑 手 臂 及 行走 机 构 的 部 件 。 一 般 情况 下 ， 实 现 臂 部 的 升 
降 、 回 转 或 俯仰 等 运动 的 驱动 装置 或 传动 件 虱 安装 在 机 里 上 。 臂 部 的 运动 越 多 ， 机 丑 的 结构 
和 受 力 越 复 茶 。 大 多 数 机 人 右 人 必须 有 一 个 便于 安装 的 基础 部 件 ， 即 机 各 人 的 基 座 ， 基 座 往往 
与 机 号 做 成 一 体 ， 机 号 既 可 以 是 固定 式 的 ， 也 可 以 是 行走 式 的 ， 即 在 它 的 下 部 装 有 能 行走 的 
机 构 ， 可 沿 地 面 或 染 空 轨道 运行 。 

种 用 的 机 号 结构 有 : 

1. 升降 回转 型 机 身 结构 

升降 回转 型 机 号 ， 顾 名 思 义 ， 机 号 有 垂直 方向 升降 和 水 平方 向 回转 两 个 自由 度 ， 可 以 采 
用 摆动 液压 红 驱 动 ， 或 用 链条 链 轮 传 动 ， 把 直线 运动 变 为 链 轮 的 回转 运动 ， 如 图 2-3 所 示 。 


























图 2-3 ”链条 链 轮 传动 实现 机 号 回 转 原理 图 
a) 单 杆 活塞 饶 驱 动 链 轮 链 条 活塞 机 构 b) 双 杆 活塞 缸 驱 动 链 轮 链 条 活塞 机 构 





2. 回转 俯仰 型 机 身 结构 

机 器 人 手臂 的 俯仰 运动 一 般 采 用 活塞 液压 〈 气 ) 征 与 连 杆 机 构 实 现 。 手 臂 俯仰 运动 的 
活塞 氏 位 于 手臂 下 方 ， 活 寒 杆 和 手臂 用 贸 链 连接 ， 红 体 采 用 尾部 耳环 或 中 部 销 轴 等 方式 与 立 
柱 连接 。 此 外 ， 有 时 也 采用 无 杆 活塞 和 驱动 齿 条 齿轮 或 四 连 丁 机 构 实 现 手臂 俯 仙 运 动 ， 如 图 
24 所 示 。 

3. 直 移 型 机 身 结构 

直 移 型 机 身 通 常设 计 成 横梁 式 ， 用 于 悬挂 手臂 部 件 ， 这 类 机 器 人 的 运动 形式 大 多 为 移动 
式 。 它 具有 占 地 面积 小 、 简 单 等 优点 。 横 梁 可 设计 成 固定 型 或 行走 型 ， 一 般 横梁 安装 在 厂房 
原 有 建筑 的 梁 柱 或 有 关 设 备 上 ， 也 可 以 从 地 面 架设 ， 如 图 2-5 所 示 。 




















图 24 回转 俯仰 型 机 里 结构 图 2-5 ” 直 移 型 机 映 结构 


4. 类 人 机 器 人 机 身 结构 

傈 兰 Mark Ho 设计 的 ARTFORM No. 1 类 人 式 机 各 人 的 机 映 如 图 2-6 所 示 ， 它 的 机 号 上 除 
了 六 有 驱动 臂 部 的 运动 半 置 外 ， 还 有 驱动 足 部 运动 的 流 置 和 腰部 关 和 三 ， 徘 足 部 和 腰部 的 届 伸 
运动 来 实现 升降 ， 腰 部 关节 实现 左右 、 前 后 的 依 仲 和 人 体 轴 线 方 回 的 回转 和 运动。 
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(二 ) 手臂 
手臂 一 般 由 上 臂 、 下 臂 和 手 爱 组 成 ， 是 机 器 人 的 主要 执行 部 件 ， 它 的 作用 是 支撑 手 部 ， 
改变 手 部 的 空间 位 置 ， 满 足 机 器 人 的 作业 空间 要 求 ， 并 将 各 种 载 荷 传递 到 机 座 。 机 器 人 的 臂 
部 主要 包括 臂 杆 以 及 与 其 伸缩 、 届 伸 或 自转 等 运动 有 关 的 构件 ， 
如 传动 机 构 、 驱 动 装置 、 导 癌 定 位 装置 、 支 撑 连 接 和 位 置 检测 元 件 
等 。 此 外 ， 还 有 与 腕 部 或 手臂 的 运动 和 连接 支撑 等 有 关 的 构件 、 配 
管 配 线 等 。 

一 般 机 器 人 的 手臂 有 三 个 自由 度 ， 即 手臂 的 伸缩 、 左 右 回转 和 
升降 (或 俯仰 ) 运动 。 手 臂 的 回转 和 升降 运动 是 通过 机 座 的 立柱 
实现 的 ， 立 柱 的 横 癌 移动 即 为 手臂 的 横 移 。 手 臂 的 各 种 运动 通常 由 
驱动 机 构 和 各 种 传动 机 构 来 实现 。 手 壁 的 三 个 自由 度 可 以 有 不 同 的 








运动 (自由 度 ) 组 合 ,通常 可 以 将 其 设计 成 以 下 四 种 形式 : 图 2-6 类 人 机 器 
1. 直角 坐标 型 机 器 人 人 机 身 结构 


直角 坐标 型 机 如 人 手 部 空间 位 置 的 改变 通过 沿 三 个 互相 垂直 的 轴线 的 移动 来 实现 ， 即 沿 
着 x 轴 的 纵向 移动 ， 沿 着 y 轴 的 横 回 移动 及 沿 着 z 轴 的 升降 。 该 形式 机 带 人 的 位 置 精度 高 ， 
控制 无 耦合 、 简 单 ， 避 降 性 好 ， 但 结构 较 庞 大 ， 动 作 范 围 小 ， 灵 活性 差 ， 难 与 其 他 机 天 人 协 
调 ; 移动 轴 的 结构 较 复杂 ， 且 占 地 面积 较 大 ， 如 图 227 所 示 。 

2. 圆柱 坐标 型 机 器 人 

圆柱 坐标 型 机 大 人 通过 两 个 移动 和 一 个 转动 实现 手 部 空间 位 置 的 改变 ，VERSATRAN 机 
船 人 是 该 型 机 带 人 的 典型 代表 (图 2-8)。VERSATRAN 机 带 人 手臂 的 运动 系 由 坪 直 立柱 平面 
内 的 伸 绑 和 沿 立柱 的 升降 两 个 直线 运动 及 手臂 绕 立 柱 的 转动 复合 而 成 。 圆 柱 坐 标 型 机 严 人 的 
位 置 精度 仅 次 于 直角 坐标 型 ， 控 制 简单 ， 避 隐 性 好 ， 但 结构 也 较 庞 大 ， 难 与 其 他 机 名 人 协调 
工作 ， 两 个 移动 轴 的 设计 较 复 杂 。 























图 2-7 直角 坐标 型 机 器 人 图 2-8 VERSATRAN 机 器 人 


3. 球 坐 标 型 机 器 人 
球 坐 标 型 机 骨 人 手臂 的 运动 由 一 个 直线 运动 和 两 个 转动 所 组 成 ， 如 图 2-9 所 示 ， 即 沿 手 
臂 方向 * 轴 的 伸缩 、 绕 y 轴 的 信仰 和 绕 z 轴 的 回转 。UNIMATE 机 硕 人 是 其 典型 代表 。 这 类 


第 二 章 工业 机 器 人 的 组 成 及 工作 原理 “人 


机 融 人 占 地 面积 较 小 ， 结 构 紧 次 ， 位 置 精度 尚 可 ， 能 与 其 他 机 答 人 协调 工作 ， 重 量 较 轻 ， 但 
避 障 性 差 ， 有 平衡 问题 ， 位 置 误差 与 辟 长 有 关 。 


x 


~ 














图 2 ” 球 坐 标 型 机 器 人 图 2-10 关 市 坐标 型 机 带 人 


4. 关节 坐标 型 机 器 人 

关节 坐标 型 机 器 人 主要 由 立柱 、 前 臂 和 后 臂 组 成 (图 2-10) ，PUMA 机 融 人 是 其 代表 。 
机 需 人 的 运 劲 由 前 、 后 臂 的 俯仰 及 立柱 的 回转 构成 ， 其 结构 最 紧凑 ， 灵 活性 大 ， 占 地 面积 最 
小 ,工作 空间 最 大 ， 能 与 其 他 机 顺 人 协调 工作 ， 避 障 性 好 ， 但 位 置 精度 较 低 ， 有 和 平衡 问题 ， 
控制 存在 耦合 ， 故 比较 复杂 ， 这 种 机 器 人 目前 应 用 得 最 多 。 

(三 ) 末端 执行 器 

机 器 人 为 了 进行 作业 ， 在 机 器 人 手 腻 上 安装 有 直接 抓 握 工件 或 执行 作业 的 部 件 ， 称 为 机 
器 人 的 手 部 或 未 端 执 行 器 ， 它 可 以 是 二 手指 或 多 手指 的 手 爪 ， 也 可 以 是 嘎 漆 枪 、 焊 枪 等 作业 
本 

1. 机 器 人 手 部 的 特点 

(1) 手 部 与 手腕 相连 处 可 拆 印 ” 手 部 与 手 脐 有 机 械 接口 ， 也 可 能 有 电 、 气 、 液 接 涉 。 工 
业 机 器 人 作业 对 象 不 同时 ， 可 以 方便 地 拆 和 纯 和 更 换 手 部 。 

(2) 手 部 的 通用 性 比较 差 机 器 人 手 部 通 稼 是 专用 的 装置 ， 例 如 ， 一 种 手 爪 往往 只 能 抓 
握 一 种 或 几 种 在 形状 、 尺 寸 、 重 量 等 方面 相近 似 的 工件 ; 一 种 工具 只 能 执行 一 种 作业 任务 。 

(3) 手 部 是 一 个 独立 的 部 件 “ 它 对 于 整个 工业 机 器 人 来 说 是 完成 作业 好 坏 以 及 作业 柔性 
好 坏 的 关键 部 件 之 一 。 具 有 复杂 感知 能 力 的 智能 化 手 爪 的 出 现 增加 了 工业 机 顺 人 作业 的 灵活 
性 和 可 靠 性 。 

2. 机 器 人 手 部 的 结构 

机 器 人 手 部 的 主要 功能 是 抓 握 和 释放 工件 ， 如 果 手 部 是 某 种 工具 ， 则 其 功能 为 该 工具 的 
作业 功能 ， 如 焊接 或 喷漆 等 。 下 面 主 要 介绍 具有 抓 握 和 释放 功能 的 手 爪 结构 并 简单 介绍 专用 
手 的 结构 。 

(1) 夹 钳 式 手 爪 ， 夹 钳 式 是 工业 机 需 人 最 稼 用 的 一 种 手 部 形式 ， 一 般 由 手指 、 传 动机 
构 、 驱 动 装 置 和 支架 组 成 ， 如 图 2-11 所 示 。 

1) 手指 。 它 是 直接 与 工件 5 接触 的 构件 。 手 部 松 开 和 夹 紧 工件 ， 就 是 通过 手指 的 张 开 
和 闭合 来 实现 的 。 一 般 情 况 下 ， 机 器 人 的 手 部 只 有 两 个 手指 ， 少 数 有 三 个 或 多 个 手指 。 



































NN Tm A 


QD 指 问 结构。 结构 形式 常 取决 于 被 夹 持 工件 的 形状 和 特性 ， 如 图 2-12 所 示 。 例 如 ， 硅 
工件 为 圆柱 形 ， 往 往 采 用 V 形 手 指 ; 知 
工件 为 方形 ， 则 一 般 采 用 平面 指 ; 夹 持 小 
型 或 麻 性 工件 用 尖 指 ; 对 于 不 规则 形状 的 
工件 ， 用 专用 特 形 指 。 

G@) 指 面 形 式 。 根 据 工件 形状 、 大 小 及 
其 被 夹 持 部 位 材料 软 硬 、 表 面 性 质 等 不 
同 ， 手指 的 指 面 有 光滑 指 面 、 齿 形 指 面 和 
柔性 指 面 三 种 形式 。 

(3 手指 材料 。 手 指 材料 选用 恰当 与 

















否 , 对 机 器 人 的 使 用 效果 有 很 大 的 影响 。 图 2 夹 钳 式 于 丰 
对 于 夹 钳 式 手 部 ， 其 手指 材料 可 选用 一 般 


碳 素 钢 和 合金 结构 钢 。 


V 形 指 





特 形 指 





图 2-12 ” 夹 钳 手 爪 指 端 


2) 传动 机 构 。 传 动机 构 是 将 驱动 源 的 驱动 力 向 手指 传递 ， 以 实现 夹 紧 和 松 开动 作 的 机 
构 。 根 据 手 指 开 合 的 动作 特点 可 分 为 回转 型 和 平移 型 两 类 。 

由 回转 型 传动 机 构 。 夹 钳 式 手 部 中 较 多 的 是 回转 型 手 部 ， 其 手指 就 是 一 对 (或 几 对 ) 
杠杆 ， 再 同 斜 机 、 消 槽 、 连 杆 、 齿 轮 、 蜗 轮 蜗杆 或 螺杆 等 机 构 组 成 复合 式 杠杆 传动 机 构 ， 来 
改变 传 力 比 、 传 动 比 及 运动 方向 等 。 

图 2-13 所 示 为 单 作用 和 斜 棉 式 回转 型 手 不 的 结构 图 。 斜 横向 下 运动 ， 克 服 弹 蝎 拉力 ， 使 
杠杆 手指 装着 深 子 的 一 端 向 外 撑 开 ， 从 而 夹 紧 工 件 。 鲜 横 向 上 移动 ， 则 在 弹 签 拉 力作 用 下 ， 
使 手指 松 开 。 手 指 与 斜 棉 通 过 深 子 接触 可 以 减 小 摩擦 力 ， 提 高 机 械 效 紊 。 有 时 为 了 人 简化 结 
构 ， 也 可 让 手指 与 斜 攀 直 接 接触 。 

图 2-14 所 示 为 滑 模式 杠杆 双 文 点 回转 型 手 爪 简 图 。 杠 杆 型 手指 的 一 端 装 有 YV 形 指 ， 故 
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一 端 则 开 有 长 滑 槽 。 驱 动 杆 上 的 圆柱 销 套 在 滑 槽 内 ， 当 驱动 连 杆 同 圆柱 销 一 起 做 往复 运动 
时 ， 即 可 拨 动 两 个 手指 各 绕 其 文 点 〈 贸 销 ) 做 相对 回转 运动 ， 从 而 实现 手指 对 工件 的 夹 紧 
与 松 开 。 





























图 2-13 ”和 斜 横 式 回转 型 手 爪 图 2-14 滑 覃 式 杠杆 回转 型 手 扑 
1 一 指 座 ”2 一 斜 棉 驱 动 丁 3 一 深 子 4 一 圆柱 销 1 一 驱动 杆 2 一 圆柱 销 ”3 一 贸 销 
5 一 拉 筑 6 一 贸 销 7 一 手指 8 一 工件 4 一 手指 5 一 V 形 指 6 一 工件 








图 2-15 所 示 为 双 支 点 连 杆 杠杆 式 回转 型 手 爪 简 图 。 驱 动 杆 末端 与 连 杆 由 匀 销 贸 接 ， 当 
驱动 杆 做 直线 往复 运动 时 ， 则 通过 连 杆 推动 两 手指 各 绕 文 点 做 回转 运动 ， 从 而 使 手指 松 开 或 
闭合 。 该 机 构 活 动 环 市 较 多 ， 定 心 精度 一 般 比 冬 模 传 动 差 。 























图 2-15” 双 支 点 连 杆 杠杆 式 回 转型 手 爪 图 2-16 齿轮 杠杆 式 回转 型 手 爪 
1 一 指 座 ”2 一 驱动 杆 3 一 贸 销 4 一 连 杆 1 一 指 座 ”2 一 驱动 杆 3 一 小 轴 4 一 局 形 齿轮 
5、7 一 圆柱 销 ”6 一 手指 8 一 V 形 指 9 一 工件 5 一 手指 6 一 V 形 指 7 一 工件 











图 2-16 所 示 为 由 齿轮 齿 条 直接 传动 齿轮 杠杆 式 回 转型 手 爪 简 图 。 了 驱动 杆 末 端 制 成 双 面 
齿 条 ， 与 虱 形 齿轮 相 路 合 ， 而 书 形 齿轮 与 手指 固 连 在 一 起 ， 可 组 文 点 回转 。 驱 动力 推动 齿 条 
做 上 下 往复 运动 ， 即 可 种 动 夺 形 齿轮 回转 ， 从 而 使 手指 闭合 或 松 开 。 

平移 型 传动 机 构 。 平 移 型 夹 钳 式 手 扑 是 通过 手指 指 面 的 直线 往复 运动 ， 或 平面 移动 实 
现 张 开 与 闭合 动作 的 。 常 用 于 夹 持 具有 平行 平面 的 工件 ( 如 箱 体 )， 因 其 结构 较 复 洒 ， 不 如 
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回转 型 应 用 广泛 。 平 移 型 传动 机 构 根 据 其 结构 不 同 ， 大 致 分 为 平面 平行 移动 机 构 和 直线 往复 
移动 机 构 两 种 类 型 。 图 2-17 所 示 为 儿 种 平面 平行 移动 机 构 手 爪 的 简 图 。 它 们 通过 驱动 器 和 
驱动 元 件 带动 平行 四 边 形 匀 链 机 构 ， 以 实现 手指 平移 。 图 2-17a、b 所 示 均 为 齿轮 齿 条 传动 
手 爪 ， 图 2-17e 所 示 为 连 杆 和 儿 滑 权 传 动手 爪 。 














图 2-17 平面 平行 移动 机 构 手 扑 
1 一 驱动 杆 ”2 一 驱动 播 杆 ”3 一 从 动 播 杆 4 一 手指 
图 2-18 所 示 为 几 种 直线 往复 移动 机 构 手 爪 简 图 。 实 现 直 线 往复 移动 的 机 构 很 多 ， 常 用 
的 斜 棉 传 动 、 齿 条 传动 、 螺 旋 传 动 等 均 可 应 用 于 手 扑 结构。 其 中 图 2-18a 为 和 斜 攀 平 移 机 构 ， 
图 2-18b 为 连 杆 杠杆 平移 机 构 ， 图 2-18e 为 螺旋 斜 攀 平 移 机 构 。 它 们 可 以 是 双 指 型 的 ， 也 可 
以 是 三 指 〈 或 多 指 ) 型 的 。 
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a) b) c) 
图 2-18 ”直线 往复 移动 机 构 手 扑 


Go 驱动 朔 置 。 它 是 癌 传 动机 构 提供 动力 的 装置 。 按 驱动 方式 不 同 有 液压 、 气 动 、 电 动 和 
电磁 驱动 之 分 。 气 动手 爪 目前 得 到 广泛 的 应 用 ， 因 为 气动 手 扑 有 许多 突出 的 优点 : 结构 简 
单 、 成 本 低 、 维 修 容易 ， 而 且 开 合 迅速 ， 重 量 轻 ， 其 缺点 是 空气 介质 的 可 压缩 性 ， 使 爪 钳 位 
置 控制 比较 复杂 。 液 压 驱动 手 爪 成 本 稍 高 一 些 。 电 动手 爪 的 优点 是 手 扑 开 合 电动 机 的 控制 与 
机 需 人 控制 可 以 共用 一 个 系统 ， 但 是 夹 紧 力 比 气 动 、 液 压 手 爪 小 ， 开 合 时 间 比 它们 长 。 电 磁 
力 手 爪 控制 信号 简单 ， 但 是 夹 紧 的 电磁 力 与 爪 钳 行程 有 关 ， 因 此 ， 只 用 在 开 合 距 离 小 的 场 
人 

(4 支撑 元 件 。 支 撑 元 件 的 作用 是 使 机 器 人 的 手 部 与 手腕 相连 接 。 文 撑 元 件 一 般 为 法 兰 式 
机 械 接口 。 当 一 人 台 机 各 人 需要 换 装 不 同 的 末端 执行 融 进 行 多 种 作业 ( 如 用 手 爪 搬运 工件 ， 
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之 后 用 焊 钳 焊接 工件 ) 时 ， 束 需要 用 到 机 带 人 工具 快 换 装 置 (Robotie Tool Changer) ， 也 被 
称 为 自动 工具 转换 装置 (ATC) 、 机 器 人 工具 转换 、 机 器 人 换 接 器 、 机 需 人 连接 头等 。 

如 图 2-19 所 示 ， 工 具 快 换 痛 置 一 般 由 两 部 
分 组 成 ， 包 括 一 个 主 侧 ， 安 装 在 机 胡 人 手臂 上 和 
一 个 工具 侧 ， 安 装 在 末端 执行 部 上 ， 如 焊 钳 或 抓 
手 。 大 多 数 的 机 规 人 工具 快 换 装置 使 用 气体 锁 紧 
主 侧 和 工具 侧 ， 工 具 快 换 装 置 能 够 让 电信 号 、 视 
频 、 超 声 、 气 体 、 水 介质 等 从 机 仑 人手 臂 连通 到 
末 闪 执行 着; 能 承受 手 部 的 工作 载 集 ; 在 失 电 、 
失 气 的 情况 下 ， 机 带 人 停止 工作 时 不 会 让 末端 执 
行 奋 自行 脱离 。 一 个 机 需 人 主 侧 可 以 根据 用 户 的 
实际 情况 与 多 个 工具 侧 配合 使 用 ， 工 具 更 换 在 数 


秒 内 完成 ， 大 大 降低 停工 时 间 ， 大 大 提高 生产 线 
加 工 制造 的 柔性 化 和 生产 效率 。 机 器 人 手 扑 


(2) 吸附 式 手 爪 ”吸附 式 手 爪 靠 吸附 力 抓 取 
工件 ， 特 别 适用 于 抓 取 大 平面 ( 单 面 接触 无 法 抓 
取 ) 、 易 碎 (玻璃 制品 ) 、 微 小 (不 易 抓 取 ) 的 图 2-19 工具 避 换 交 置 
工件 或 物体 ， 与 机 械 夹 钳 式 手 扑 相 比 ， 具 有 结构 简单 、 重 量 轻 、 抓 取 力 分 布 均匀 的 优点 ， 适 
用 面 较 广 。 根 据 吸附 力 的 产生 方法 不 同 ， 将 其 分 为 气 吸 式 和 磁 吸 式 两 大 类 。 

1) 气 吸 式 手 爪 。 气 吸 式 手 爪 是 工业 机 器 人 常用 的 一 种 吸 持 工件 的 装置 。 它 由 吸盘 (一 
个 或 几 个 ) 、 吸 盘 架 及 进 排 气 系统 组 成 ， 具 有 结构 简单 、 重 量 轻 、 使 用 方便 可 靠 等 优点 ， 广 
泛 应 用 于 非 金属 材料 (如 板材 、 纸 张 、 玻 璃 等 物体 ) 或 不 可 有 剩 磁 材 料 的 吸附 。 

气 吸 式 手 爪 的 一 个 特点 是 要 求 工件 表面 没有 损伤 ， 与 吸盘 接触 部 位 光滑 平整 、 清 洁 ， 被 
吸 工件 材质 致密 ,没有 透气 空 阶 ， 且 对 被 吸 持 工 件 预定 的 位 置 精度 要 求 不 高 。 

气 吸 式 手 扑 是 利用 吸盘 内 的 压力 与 大 气压 之 间 的 压力 差 而 工作 的 。 按 形成 压力 差 的 方式 
不 同 ， 可 分 为 真空 抽 气 式 、 气 流 负 压 式 和 挤 压 排 气 式 。 

QOD 挤 压 排 气 式 。 手 爪 抓 取 工件 时 ， 橡 胶 吸 副 压 紧 工件 从 
而 发 生变 形 ， 挤 出 腔 内 多 余 的 空气 。 当 手 爪 上升 时 ， 靠 橡胶 
吸盘 的 恢复 力 使 其 腔 内 与 外 界 气压 之 间 形 成 负 压 ， 从 而 将 工 
件 吸 住 。 释 放 工 件 时 ， 压 下 拉杆 ， 使 吸盘 腔 与 大 气相 连通 而 
失去 负 压 。 挤 压 排 气 式 手 爪 结构 简单 ， 但 吸附 力 有 限 ， 吸 附 
状态 不 易 长 期 保持 ， 如 图 2-20 所 示 。 | 

气流 负 压 式 。 气 流 负 压 式 手 扑 ( 图 2221) 利用 流体 
力学 中 射流 的 原理 ， 当 需要 抓 取 工 件 时 ， 高 速 高 压 空气 流 经 
喷嘴 时 ， 其 出 口 处 的 气压 低 于 吸盘 腔 内 的 气压 ， 于 是 腔 内 的 
气体 被 高 速 气流 带 走 而 形成 负 压 ， 由 此 产生 吸力 ， 完 成 抓 取 
工件 的 动作 。 当 需要 释放 工件 时 ， 切 断 高 速 高 压 空气 即 可 。 
气流 负 压 需要 的 压缩 空气 ， 在 工厂 内 容易 取得 ， 故 成 本 较 ”图 220 挤 压 排 气 式 手 爪 结构 
低 ， 且 吸附 可 靠 ， 控制 简单 。 1 
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(5) 真空 抽 气 式 。 真 空 抽 气 式 手 爪 (图 2-22) 的 真空 是 由 真空 人 汞 抽 气 产生 的 ， 真 空 度 较 
， 所 以 吸附 力 最 大 。 当 和 宕 要 抓 取 工 件 时 ， 碟 形 橡 胶 吸 盘 与 工件 表面 接触 ， 然 后 真空 泵 抽 
， 上 吸盘 腔 内 形成 真空 ， 产 生 吸力 ， 从 而 完成 抓 取 工件 动作 。 当 知 要 释放 工件 时 ， 管 路 接 通 
大 气 ， 吸 盘 腔 内 失去 真空 即 可 。 为 了 避免 在 取 料 时 产生 撞击 ， 有 的 还 在 支撑 杆 上 配 有 弹 蝎 绥 
冲 ; 为 了 更 好 地 适应 物体 吸附 面 的 倾斜 状况 ， 有 的 在 橡胶 吸盘 背面 设计 有 球 贸 链 。 真 空 抽 气 
式 手 爪 工作 可 笔 ， 吸 附 力 大 ， 但 需要 真空 系统 ， 成 本 较 高 。 
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图 2-21 气流 负 压 式 手 爪 结构 图 2-22 ”真空 抽 气 式 手 爪 结构 
1 一 橡胶 吸盘 ”2 一 心 套 3 一 通气 螺钉 1 一 橡胶 吸盘 ”2 一 固定 环 3 一 垫 片 
4 一 支撑 杆 ”5 一 喷嘴 ”6 一 喷嘴 套 4 一 支撑 杆 5 一 基板 6 一 螺母 


2) 磁 吸 式 手 爪 。 磁 吸 式 手 扑 是 利用 磁场 产生 的 磁 吸 力 来 抓 取 工件 的 ， 有 较 大 的 单位 面 
积 吸力 ， 对 工件 表面 粗糙 度 及 通 孔 、 沟 槽 无 特殊 要 求 。 但 只 能 对 铁 磁性 工件 起 作用 ( 钢 、 
铁 等 材料 在 温度 超过 723%C 时 就 会 失去 磁性 )。 另 外 ， 对 不 允许 有 剩 磁 的 工件 要 禁止 使 用 ， 
而 且 吸 附 头 上 常 吸附 磁性 悄 (如 铁 悄 ) ， 往 往 会 影响 正常 工作 。 所 以 磁 吸 式 手 爪 的 使 用 有 一 
定 的 局 限 性 。 根 据 磁场 产生 的 方法 不 同 ， 磁 吸 式 手 爪 可 分 为 永 磁 式 和 电磁 式 两 类 。 

O 永 磁 式 。 永 磁 式 手 扑 是 利用 永久 磁 钢 的 磁 吸力 来 工作 的 ， 通 过 移动 隔 磁 物体 来 改变 吸 
盘 内 的 磁力 线 回路 ， 从 而 达到 吸 住 和 释放 工件 的 目的 (也 可 用 外 力 强迫 取 下 工件 )。 它 具有 
不 需要 电源 、 结 构 简 单 、 安 全 可 靠 等 优点 ， 缺 点 是 长 时 间 使 用 后 会 出 现 磁 吸力 减弱 的 现象 ， 
而 且 对 同样 重量 的 吸盘 来 讲 ， 其 吸 
力 不 及 电磁 式 。 

电磁 式 。 电 磁 式 手 扑 是 用 接 
通 和 切断 电磁 线圈 中 的 电流 (直流 
或 交流 ) ， 产 生 和 消除 磁 吸 力 的 方法 
来 吸 住 和 释放 工件 的 。 当 衔 铁 接触 
铁 磁性 工件 时 ， 工 件 被 磁化 形成 磁 
力 线 回 路 并 受到 电磁 吸力 而 被 吸 住 ， 
其 工作 原理 如 图 2-23 所 示 。 电 磁 式 图 2-23 电磁 铁 工作 原理 
手 爪 的 各 种 形状 如 图 2-24 所 示 。 人 
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(3) 专用 手 (工具 ) ”机 人 右 人 的 专用 手 是 指 用 来 完成 某 一 特定 操作 的 、 具 有 特殊 功能 的 
末端 执行 釉 ， 其 实质 就 是 各 种 各 样 的 专用 工具 ， 例 如 焊接 机 釉 人 的 焊 钳 、 焊 枪 ， 喷 涂 机 化 人 
的 喷枪 等 。 目 前 利用 的 机 需 人 专用 手 有 和 焊 钳 、 焊 枪 、 喷 枪 、 砂 轮 、 拧 螺母 机 、 激 光 切 割 机 、 
滚轮 等 ， 如 图 2-25 所 示 。 








滚动 轴承 座 圈 






电磁 式 手 扑 
c) d) 


图 2-24 电磁 式 手 扑 





滨 轮 激光 切割 机 17 
图 2-25 ”机 器 人 专用 工具 














mn 


1) 点 焊 焊 钳 结构 。 “一 体式 ”点 焊 机 器 人 焊 钳 的 结构 形式 为 焊 钳 的 两 电极 臂 与 焊接 变 
压 融 、 变 压 顺 二 次 侧 汇流 铜 排 制 成 一 体 〈 图 2-26) ， 然 后 共同 固定 在 机 需 人 手臂 末端 的 法 兰 
盘 上 。 

按 电极 臂 形 状 又 可 分 为 C 型 焊 钳 及 X 型 焊 钳 两 种 。C 型 焊 钳 的 特点 是 只 有 一 个 动 电极 ， 
因此 结构 简单 ， 电 极 压 力 较 大 并 稳定 ， 但 不 如 X 型 焊 钳 灵 活 。X 型 焊 钳 的 结构 特征 是 : 焊 
钳 的 两 个 电极 辟 在 工作 时 以 心 轴 (图 2-226) 为 文 点 可 同时 张 开 或 财 合 。 


伺服 电动 机 
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C 型 得 钳 X 型 焊 刍 
图 2-26 点 焊 焊 钳 结构 


X 型 点 焊 焊 钳 用 于 点 焊 水 平 及 接近 水 平 位 置 的 焊 点 ， 电 极 的 运动 轨迹 为 圆 弧 线 。C 型 点 
焊 焊 钳 用 于 点 焊 垂 直 及 接近 垂直 的 焊 点 ， 电 极 做 直线 运动 。 一 般 人 情况 下 ， 焊 点 距离 制 件 边缘 
超过 300mm 的 情形 选择 X 型 焊 钳 ， 焊 点 距离 制 件 边缘 小 于 300mm 的 情形 可 以 选择 X 型 、C 
型 焊 钳 。 

2) 点 焊 焊 钳 的 驱动 。 焊 钳 有 “气动 ”和 “电动 机 伺服 驱动 ”两 种 形式 。 “气动 ”是 使 
用 压缩 空气 驱动 “加 压气 和 缸 ” 活 塞 ， 然 后 由 活塞 带动 电极 臂 财 合 或 张 开 ， 如 C 型 焊 钳 。 一 
般 气 缸 有 两 个 行程 ， 使 焊 钳 两 个 电极 臂 之 间 有 辅助 行程 和 工作 行程 两 种 工作 过 程 。 

“电动 机 伺服 驱动 ”的 焊 钳 简称 为 “伺服 焊 钳 ”"， 是 利用 伺服 电动 机 代替 压缩 空气 作为 
动力 源 ， 通 过 相应 的 力 变 换 机 构 带 动 两 电极 臂 闭合 或 张 开 的 一 种 焊 钳 。 电 动机 伺服 驱动 是 利 
用 电动 机 脉冲 码 盘 反馈 张 开 程度 ， 这 种 焊 钳 的 张 开 度 可 以 根据 实际 需要 任意 选 定 并 预 置 ， 而 
且 电 极 间 的 压 紧 力也 可 以 无 级 调节 。 何 服 焊 钳 由 于 采用 的 是 伺服 电动 机 ， 电 极 的 动作 速度 在 
接触 到 工件 前 ， 可 由 高 速 准确 调整 到 低速 。 这 样 就 可 以 形成 电极 对 工件 软 接触 ， 减 轻 电 极 冲 
击 所 造成 的 压 痕 ， 从 而 也 减轻 了 后 续 工 件 表面 修 麻 处 理 量 ， 是 一 种 可 提高 焊 点 质量 、 性 能 较 
高 的 机 釉 人 用 焊 钳 。 


二 、 驱 动 狐 置 


机 占 人 的 驱动 方式 可 以 是 液压 驱动 、 气 动 驱 动 、 电 气 驱 动 ， 或 者 是 这 几 种 驱动 结合 起 来 
应 用 的 综合 驱动 ， 可 以 直接 驱动 或 者 通过 同步 带 、 链 条 、 轮 系 、 谐 波 齿 轮 等 机 械 传动 机 构 进 
行 间接 驱动 。 

(一 ) 液压 驱动 

液压 驱动 的 特点 是 能 够 以 较 小 的 驱动 带 输 出 较 大 的 驱动 力 或 力 窍 ， 即 获得 较 大 的 功率 重 
量 比 。 而 且 可 以 把 驱动 液压 负 直 接 做 成 关 市 的 一 部 分 ， 使 结构 简单 紧 竣 ， 刚 性 好 。 由 于 液体 
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的 不 可 压缩 性 ， 定 位 精度 比 气压 驱动 高 ， 可 实现 任意 位 置 的 开 停 。 液 压 驱 动 调 速 比较 简单 和 
平稳 ， 可 在 较 大 范围 内 实现 无 级 调 速 。 但 是 ,液压 驱动 的 问题 是 油 液 容易 泄漏 ， 这 不 仅 影响 
工作 的 稳定 性 与 定位 精度 ， 而 且 会 造成 环境 污染 。 油 液 中 易 混 和 气泡、 水 分 等 ， 使 系统 的 刚 
性 降低 ， 速 度 特性 及 定位 精度 变 坏 。 加 之 需要 配备 压力 源 及 复杂 的 管 路 系统 ， 使 成 本 偏 高 。 
液压 驱动 大 多 用 于 要 求 输出 力 较 大 、 速 度 较 低 的 场合 。 近 年 来 以 电 液 伺服 系统 驱动 最 具 代 表 
性 。 

(二 ) 气压 驱动 

气压 驱动 在 工业 机 械 手 中 用 得 较 多 。 气 压 驱 动 的 特点 是 压缩 空气 的 黏 性 小 ， 流 速 大 ， 一 
般 压 缩 空 气 在 管 路 中 的 流速 可 达 180m/s， 所 以 其 快速 性 好 。 气 源 比 较 方便 ,一般 工厂 都 有 
空 压 机 供 气 ， 只 要 连接 高 压气 管 即 可 工作 ， 并 且 没 有 污染 ， 调 速 简 单 ， 只 要 调节 气量 就 可 实 
现 无 级 变速 。 由 于 空气 可 以 压缩 ， 所 以 气压 驱动 系统 具有 较 好 的 缓冲 作用 。 还 可 以 把 驱动 器 
做 成 关节 的 一 部 分 ， 使 结构 简单 、 成 本 低 、 刚 性 好 。 气 压 驱 动 的 问题 在 于 : 基于 气体 的 可 压 
缩 性 ， 气 压 驱 动 很 难保 证 较 高 的 定位 精度 ， 而 且 功 率 重 量 比 小 ， 驱 动 装置 体积 大 。 使 用 后 的 
压缩 空气 向 大 气 排放 时 会 产生 噪声 。 压 缩 空气 中 含有 冷凝 水 ， 使 气压 系统 易 锈 蚀 ， 在 低温 下 
易 结 冰 。 

(三 ) 电气 驱动 

电气 驱动 是 利用 各 种 电动 机 产生 力 和 转 矩 ， 直 接 或 经 过 机 械 传动 机 构 去 驱动 机 器 人 运 
动 。 因 为 省 去 了 中 间 的 能 量 转换 过 程 ， 所 以 比 液 压 及 气动 驱动 效率 高 。 随 着 大 功率 交流 伺服 
驱动 技术 的 发 展 ， 目 前 大 部 分 工业 机 需 人 采用 电气 驱动 方式 ， 只 有 在 少数 要 求 超大 的 输出 功 
率 、 防 爆 、 低 运动 精度 的 场合 才 考虑 使 用 液压 和 气压 驱动 。 电 气 驱 动 无 环境 污染 ， 响 应 快 ， 
精度 高 ， 成 本 低 ， 控 制 方便 。 

电气 驱动 按照 驱动 执行 元 件 的 不 同 又 分 为 步 进 电动 机 驱动 、 直 流 伺服 电动 机 驱动 和 交流 
伺服 电动 机 驱动 三 种 形式 。 

1. 步 进 电动 机 

步 进 电 动机 是 一 种 将 脉冲 电信 号 转换 为 角 位 移 或 直线 位 移 的 控制 电动 机 。 每 当 输 入 一 个 
电 脉冲 时 ， 它 便 转 过 一 个 角度 ， 这 个 角度 称 为 步 距 角 ， 简 称 步 距 。 脉 冲 一 个 一 个 地 输入 ， 电 
动机 便 一 步 一 步 地 转动 ， 步 进 电 动机 因此 而 得 名 。 

从 电动 机 绕组 所 加 的 电源 形式 来 看 ， 与 一 般 的 交 直 流 电动 机 也 有 所 区 别 ， 它 既 不 是 正弦 
波 ， 也 不 是 恒定 电压 ， 而 是 脉冲 电压 ， 所 以 有 时 也 称 这 种 电动 机 为 脉冲 电动 机 。 

(1) 步 进 电动 机 的 优点 

1) 输出 角度 精度 高 ， 无 积累 误差 ， 惯 性 小 。 步 进 电动 机 的 输出 精度 主要 由 步 距 角 来 反 
上 映 。 目 前 步 距 角 一 般 可 以 做 到 0. 002。~ 0. 005" 甚 至 更 小 。 步 进 电动 机 的 实际 步 距 角 与 理论 步 
距 角 总 存在 一 定 的 误差 ， 这 误差 在 电动 机 旋转 一 周 的 时 间 内 会 逐步 积累 ,但 当 电 动机 旋转 一 
周 后 ， 其 转轴 又 回 到 初始 位 置 ， 使 误差 回 到 零 。 

2) 输入 和 输出 呈 严 格 线性 关系 。 输 出 角度 不 受 电 压 、 电 流 及 波形 等 因素 的 影响 ， 仅 取 
决 于 输入 脉冲 数 的 多 少 。 

3) 容易 实现 位 置 、 速 度 控制 ， 起 、 停 及 正 、 反 转 控制 方便 。 步 进 电动 机 的 位 置 (输出 
角度 ) 由 输入 脉冲 数 确定 ， 其 转速 由 输入 脉冲 的 频率 决定 ， 正 、 反 转 ( 转 向) 由 输入 脉冲 
的 顺序 决定 ， 而 脉冲 数 、 脉 冲 频 率 、 脉 冲 顺 序 都 可 方便 地 由 计算 机 输出 控制 。 
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4) 输出 信号 为 数字 信号 ， 可 以 与 计算 机 直接 接口 。 

5) 结构 人 简单， 使 用 方便 ,可靠 性 好 ， 寿 命 长 。 

(2) 步 进 电动 机 的 类 型 ”按照 励磁 方式 不 同 ， 步 进 电动 机 有 反应 式 、 永 磁 式 和 混合 式 
三 种 类 型 。 

1) 反应 式 步 进 电动 机 〈(VR) 。 定 子 上 有 绕组 ， 转 子 由 软 磁 材 料 组 成 。 结 构 简 单 ， 成 本 
低 ， 步 距 角 小 ， 可 达 1.2°， 但 动态 性 能 差 .效率 低 ， 发 热 大 ， 可 靠 性 难保 证 。 

2) 永 磁 式 步 进 电动 机 (PM) 。 永 磁 式 步 进 电动 机 的 转子 用 永 磁 材 料 制 成 ， 转 子 的 极 数 
与 定子 的 极 数 相同 。 其 特点 是 动态 性 能 好 ， 输 出 转 矩 大 ,但 这 种 电动 机 精度 差 ， 步 距 角 大 
有 

3) 混合 式 步 进 电动 机 〈HB) 。 混 合式 步 进 电动 机 综合 了 反应 式 和 了 永 磁 式 的 优点 ， 其 定 
子 上 有 多 相 绕 组 ， 转 子 上 采用 永 磁 材 料 ， 转 子 和 定子 上 均 有 多 个 小 齿 ， 以 提高 步 距 精度 。 其 
特点 是 输出 转 矩 大 ， 动 态 性 能 好 ， 步 距 角 小 ,但 结构 复杂 ,成 本 相对 较 高 ， 是 目前 性 能 最 高 
的 步 进 电动 机 。 它 有 时 也 称 作 永 磁感应 子 式 步 进 电动 机 。 

(3) 步 进 电动 机 的 原理 ”这 里 以 反应 式 步 进 电动 机 为 例 说 明 其 工作 原理 。 

图 2-27 所 示 为 三 相反 应 式 步 进 电 动机 的 前 面 
示意 图 。 电 动机 的 定子 上 有 六 个 均 布 的 磁极 ,其 
夹 角 是 60"。 各 磁极 上 套 有 线圈 ， 按 图 2-27 连 成 
A、B、C 三 相 绕 组 。 转子 上 均 布 40 个 小 齿 。 所 以 
每 个 齿 的 齿 距 为 9; =360°/40 =9°*， 而 定子 每 个 磁 
极 的 极 弧 上 也 有 五 个 小 从 ， 且 定子 和 转子 的 齿 距 
和 齿 宽 均 相同 。 由 于 定子 和 转子 的 小 齿 数 目 分 别 
是 30 和 40， 其 比值 是 一 个 分 数 ， 这 就 产生 了 所 训 
“ 齿 错 位 ”的 情况 。 当 A 相 控 制 绕 组 通电 ,而 B 
相 和 C 相 不 通电 时 ， 步 进 电动 机 的 气 隐 磁 场 与 A 
相 绕 组 轴线 重合 ， 而 磁力 线 总 是 力图 从 磁 阻 最 小 
的 路 径 通过 ， 故 电动 机 转子 受到 一 个 反应 转 抢 ， 
在 步 进 电动 机 中 称 为 静 转 矩 。 在 此 转 矩 的 作用 下 ， 转 子 上 的 小 齿 与 定子 AA 上 的 小 齿 对 章 ， 
那么 B 相 和 C 相 磁 极 的 齿 就 会 分 别 和 转子 齿 相 错 三 分 之 一 的 齿 距 ， 即 3*。 因 此 ，B、C 磁极 
下 的 磁 阻 比 A 人 磁极 下 的 磁 阻 大 。 奉 A 相 断 电 ，B 相通 电 ， 同 样 使 转子 受到 反应 转 矩 〈 磁 阻 
转 矩 ) 的 作用 而 转动 ， 直 到 转子 小 齿 与 BB 人 磁极 上 的 齿 对 齐 ， 恰 好 转子 转 过 3°*。 此 时 A、C 
位 极 下 的 齿 又 分 别 与 转子 齿 错开 三 分 之 一 齿 距 。 接 着 集 止 对 B 相 绕 组 通电 ， 而 改 为 C 相 绕 
组 通电 ， 同 理 受 反应 转 矩 的 作用 ， 转 子 按 顺 时 针 方向 再 转 过 3°。 依 次 类 推 ， 当 三 相 绕 组 按 A 
一 B 一 C 一 A 顺序 循环 通电 时 ， 转 子 会 按 顺 时 针 方向 ， 以 每 个 通电 脉冲 转动 3* 的 规律 步 进 式 
转动 起 来 。 若 改变 通电 顺序 ， 按 A 一 C 一 B 一 A 顺序 循环 通电 ， 则 转子 就 按 道 时针 方向 以 每 
个 通电 脉冲 转动 3° 的 规律 转动 。 因 为 每 一 瞬间 只 有 一 相 绕 组 通电 ， 并 且 按 三 种 通电 状态 循 
环 通 电 ， 故 称 为 单 三 拍 运行 方 式 。 通 常 为 了 得 到 小 的 步 距 角 和 较 好 的 输出 性 能 ， 用 三 相 六 扫 
通电 方式 ， 其 通电 顺序 为 A 一 AB 一 B 一 BC 一 C 一 CA 一 A 一 …… ( 顺 时 针 ) 和 A 一 AC 一 C 一 CB 
Ds Da SA ( 逆 时 针 )， 相 应 地 绕组 的 通电 状态 每 改变 一 次 ， 转 子 转 过 1. 5°。 

步 进 电动 机 的 步 距 角 可 用 下 式 表 示 ， 即 





























图 2-27 三 相反 应 式 步 进 
电动 机 的 剖面 示意 图 
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式 中 ,9 为 步 进 电动 机 的 步 距 角 ; m 为 定子 绕组 的 相 数 ; z 为 转子 的 齿 数 ;有 为 通电 方式 常 
数 ，m 相 m 拍 通 电 时 ,k=1，m 相 2m 拍 通电 时 , 大 =2。 

2. 直流 伺服 电动 机 

伺服 一 词 源 于 希腊 语 “ 奴 隶 ” 的 意思 。 人 们 想 把 “ 何 服 机 构 ” 当 个 得 心 应 手 的 驯服 工 
具 ， 按 照 控制 信号 的 要 求 而 动作 。 在 信和 号 来 到 之 前 ， 电 动机 静止 不 动 ; 信号 来 到 之 后 ， 电 动 
机 立即 转动 ; 当 信 号 消失 ， 电 动机 能 即时 停 转 。 

直流 伺服 电动 机 本 映 就 是 直流 电动 机 ， 直 流 伺服 电动 机 的 结构 与 直流 电动 机 基本 相同 。 
只 是 为 减 小 转动 惯量 ， 电 动机 做 得 细 长 一 些 。 直 流 伺服 电 动机 的 优点 有 起 动 转 矩 大 ， 体积 
小 ， 重 量 轻 ， 能 在 较 宽 的 速度 范围 内 稳定 运行 ， 有 很 好 的 线性 调节 特性 ， 响 应 迅速 ， 可 快速 
起 动 、 增 速 、 减 速 和 停止 ， 效 率 高 ， 损 耗 小 等 。 输 出 功率 一 般 为 1 ~600W， 转 速 可 达 1500 
~ 1600r/ min。 

(1) 直流 电动 机 的 结构 ”直流 电动 机 的 结构 由 定子 和 转子 两 大 部 分 组 成 。 定 子 的 主要 
作用 是 产生 磁场 ， 由 机 座 、 主 磁极 、 换 向 极 、 端 盖 、 轴 承 和 电 刷 装置 等 组 成 。 运 行 时 转动 的 
部 分 称 为 转子 ， 其 主要 作用 是 产生 电磁 转 和 矩 和 感应 电动 势 ， 是 直流 电动 机 进行 能 量 转 换 的 枢 
纽 ， 所 以 通常 又 称 为 电 枢 ， 由 转轴 、 电 枢 铁 心 、 电 枢 绕 组 、 换 向 器 和 风扇 等 组 成 。 

(2) 直流 电动 机 的 工作 原理 ”图 228 中 N、 
S 为 永久 磁铁 ， 当 位 于 N、S 之 间 的 导体 转子 通过 
电 刷 和 换 向 器 有 电流 流 过 且 转 子 电流 和 磁 通 正 交 
时 ， 由 于 磁场 的 作用 ， 导 体 转子 两 边 产 生 方 向 相 
反 的 电磁 力 ， 从 而 形成 如 图 2-28 所 示 的 转 抢 使 导 
体 转动 。 当 导体 转 过 90" 时 ， 由 于 换 向 器 使 电流 
有 反问， 使 转子 导体 两 边 的 电磁 力 反 癌 ， 但 由 于 此 
时 转子 位 置 的 改变 正好 使 所 形成 的 转 抢 保持 原来 
相同 的 方向 ,使 转子 继续 向 同一 方向 转动 。 这 样 ， 
转子 每 转 过 180" ， 换 向 器 就 使 电流 反 向 一 次 ， 使 
得 转子 连续 不 断 地 转动 。 在 图 2-28 中 所 示 位 置 开 图 2-28 直流 电动 机 竺 构 原 理 图 
始 通电 时 ， 转 子 转 抢 最 大 。 随 着 转子 的 旋转 转 矩 逐渐 减 小 ， 直 到 转 过 90° 时 ， 转 和 矩 为 零 ， 但 
由 于 转子 惯性 的 作用 ， 转 子 仍 然 向 同一 方向 旋转 。 转 过 90" 后 ， 转 矩 又 从 零 开 始 逐 渐 增 大 。 
所 以 直流 电动 机 是 一 种 转 矩 变化 剧烈 的 电动 机 。 应 用 时 为 了 保证 电动 机 保持 一 定 的 最 大 转 
和 矩 ， 实 际 使 用 的 直流 电动 机 往往 要 设置 10 个 换 回 器 。 

3. 交流 伺服 电动 机 

直流 伺服 电动 机 结构 上 具有 电 刷 和 换 向 器 ， 需 要 定期 更 换 电 刷 和 进行 维修 ， 电 动机 使 用 
寿命 短 ， 品 声 大 。 尤 其 是 直流 电动 机 的 容量 小 ， 电 枢 电 压低 ,很 多 特性 参数 随 速度 而 变化 ， 
限制 了 直流 电动 机 向 高 速 、 大 容量 方向 发 展 。 在 一 些 具 有 可 燃气 体 的 场合 ， 由 于 电 刷 换 向 过 
程 中 可 能 引起 打 火 ， 也 不 适合 使 用 直流 电动 机 ， 如 井下 作业 等 。 所 以 近年 来 ， 随 着 交流 技术 
的 发 展 ， 直 流 伺服 电动 机 正 越 来 越 多 地 被 交流 伺服 电动 机 所 取代 。 

交流 伺服 电动 机 无 接触 换 向 部 件 ， 不 需要 定期 检查 和 维修 ， 结 构 紧 凑 。 定 子 线圈 绕 在 定 
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子 铁 心 上 ， 磁场 均匀 ， 转 子 采 用 具有 精密 磁极 形状 的 永久 磁铁， 因而 可 实现 高 转 矩 惯量 比 ， 
能 在 较 宽 的 速度 范围 内 保持 理想 的 转 矩 ， 动 态 啊 应 好 ， 结 构 简 单 ， 运 行 可 徘 。 交 流 伺 服 电 动 
机 外 形 小 ， 重 量 轻 ,一般 同样 体积 下 ， 交 流 电动 机 的 输出 功率 可 比 直 流 电 动机 高 出 10% ~ 
70% 。 男 外 ， 交 流 电 动机 的 容量 可 做 得 比 直 流 电 动机 大 ， 达 到 更 高 的 转速 和 电压 。 目 前 在 机 
僵 人 系统 中 ，90% 的 系统 采用 交流 伺服 电动 机 。 

交流 伺服 电动 机 实际 上 就 是 自 同步 三 相 永 磁 同 步 电 动机 。 所 谓 自 同步 永 磁 同步 电动 机 ， 
是 其 定子 绕组 产生 的 旋转 位 场 位 置 由 永 磁 转子 的 位 置 所 决定 ， 能 自动 地 维持 与 转子 磁场 有 
90° 的 空间 来 角 ， 以 产生 最 大 的 电动 机 转 矩 。 旋 转 磁 场 的 转速 则 严格 地 由 永 磁 转子 的 转速 所 
决定 。 用 此 种 方式 运行 的 永 磁 同 步 电动 机 除 仍 需 逆 变 硕 开 关 电 路 外 ， 还 需要 一 个 能 检测 转子 
位 置 的 传 感 带 ， 逆 变 絮 的 开关 动作 使 永 磁 同步 电动 机 定子 绕组 得 到 的 多 相 电 流 ， 完 全 由 转子 
位 置 检 测 装 置 给 出 的 信号 来 控制 。 这 种 定子 旋转 磁场 由 定子 位 置 来 决定 的 运行 方式 即 自 同步 
水 位 同步 电动 机 运行 方式 。 按照 定子 绕组 感应 电动 势 的 波形 不 同 ， 可 以 分 为 正弦 波 永 人 磁 同 步 
电动 机 (PMSM) 和 樟 形 波 永 磁 同 步 电动 机 (BLDC)。 

(1) 交流 伺服 电动 机 的 结构 ”正弦 波 永 磁 同步 电 
动机 结构 如 图 2-29 所 示 。 该 电动 机 的 定子 绕组 通常 为 
三 相 绕 组 (也 可 制 成 多 相 ， 如 四 相 、 五 相 )， 三 相 绕 
组 与 定子 铁心 对 称 分 布 ， 在 空间 互 差 120° 电 角度 ， 电 
枢 绕 组 常 以 Y 形 联结 ， 采 用 短 距 分 布 绕 组 ,， 通 入 三 相 
交流 电 时 ， 产 生 旋 转 磁 场 。 转 子 采 用 钴 铁 硼 稀 土 永 磁 
材料 取代 电 励 磁 磁 极 ， 简 化 了 结构 ， 消 除了 转子 的 集 
电 环 、 电 刷 ， 实 现 了 无 刷 结构 ， 缩 小 了 转子 体积 ; 省 
去 了 励磁 直流 电源 ， 消 除了 励磁 损耗 和 发 热 。 

(2) 交流 伺服 电动 机 的 工作 原理 ” 自 同步 永 磁 同 
步 电 动机 按 电动 机 定子 绕组 中 加 入 的 电流 形式 不 同 可 图 2229 正弦 波 永 磁 同步 电动 机 结构 
分 为 方 波 电动 机 和 正 驳 波 电 动 机 两 类 。 方 波 电 动 机 己 
有 有 刷 直 流 电动 机 工作 原理 完全 相同 ， 不 同 处 在 于 它 用 电子 开关 电路 和 转子 位 置 传 感 希 取代 了 
有 刷 直流 电动 机 的 换 回 器 和 电 刷 ， 从 而 实现 了 直流 电动 机 的 无 刷 化 ， 同 时 保持 了 直流 电动 机 
的 良好 控制 特性 ， 故 该 类 方 波 电 动机 人 们 习惯 称 为 无 刷 直 流 电 动机 (Brushless DC Motor， 
BDCM) 。 这 是 当前 在 机 器 人 伺服 驱动 系统 使 用 最 广泛 、 很 有 前 途 的 一 种 自 同 步 永 磁 同步 电 
动机 。 

正弦 波 自 同 步 永 磁 同步 电动 机 (Permanence Magnet Synchronize Motor，PMSM ) 的 定子 
绕组 得 到 的 是 对 称 三 相交 流 电 ,但 三 相交 流 电 的 频率 、 相 位 和 幅 值 由 转子 的 位 置信 号 所 决 
定 。 转 子 位 置 检 测 通常 使 用 光电 编码 器 ， 可 精确 地 获得 瞬间 转子 位 置信 息 。 其 控制 通常 采用 
单片机 或 数字 信号 处 理 絮 (DSP) 作为 控制 带 的 核心 单元 。 因 其 控制 性 能 、 控 制 精 度 和 转 算 
的 平稳 性 较 无 刷 直 流 电动 机 控制 系统 好 ， 故 在 机 器 人 伺服 驱动 中 也 广 为 采 用 。 
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机 天 人 传 感 硕 是 机 釉 人 组 成 中 很 重要 的 一 部 分 ， 机 名人 能 够 准确 地 、 以 适当 的 速度 移动 
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位 置 、 变 换 姿态 、 避 免 与 环境 中 物体 发 生 碰 撞 或 找到 抓 取 对 象 都 离 不 开 传 感 硕 提供 的 信息 ， 
机 何人 传 感 带 就 像 人 类 的 感觉 副官 ， 在 完成 工作 任务 时 发 挥 着 不 可 或 缺 的 作用 。 

根据 传 感 硕 在 机 舌 人 上 应 用 的 目的 与 使 用 的 范围 不 同 ， 将 其 分 为 两 类 : 内 部 传 感 锅 和 外 
部 传 感 船 。 用 于 检测 机 夫人 目 喘 状态 〈 如 手臂 间 角 度 ， 机 需 人 运动 的 位 置 、 速 度 等 ) 的 传 
感 硕 是 内 部 传 感 项 ;外 部 传 感 礁 用 于 检测 机 需 人 所 处 的 环境 和 对 象 的 状况 等 ， 如 判别 机 佣 人 
抓 取 对 象 的 形状 、 空 间 位置 ， 抓 取 对 象 周围 是 否 存在 障碍 ， 被 抓 取 物 体 是 否 滑落 等 。 

外 部 传 感 吉 又 可 分 为 末端 执行 锅 传 感 毅 和 环境 传 感 蕉 。 末 端 执 行 带 传 感 硕 主要 安装 在 末 
端 执 行囊 的 手 上 ， 用 于 检测 精巧 作业 的 感觉 信息 ， 类 似 于 人 的 触 党 。 环 境 传 感 硕 用 于 识别 物 
体 和 检测 物体 与 机 各 人 的 距离 等 。 使 用 外 部 传 感 带 可 提高 机 侣 人 的 适应 能 力 和 控制 水 平 ， 提 
高 机 硕 人 的 目 主 控制 能 


一 、 内 部 传 感 希 


(一 ) 位 置 传感器 

位 置 传 感 副 有 模拟 和 数字 两 类 。 模 拟 传 感 侨 有 旋转 变 压 副 、 感 应 同步 右 、 电 位 带 等 。 数 
字 传 感 顺 有 光电 盘 、 编 码 盘 、 光 栅 等 。 

1. 旋转 变压器 

旋转 变 压 带 是 一 种 输出 电压 随 角 度 变化 的 检测 六 置 ， 是 用 来 测量 角 位 移 的 。 其 结构 与 交 
流 绕 线 式 异步 电动 机 相似 ， 由 定子 和 转子 组 成 。 定 、 转 子 铁心 由 导 磁 性 能 良好 的 电工 钢 片 靶 
成 ， 定 子 铁心 内 圆 和 转子 铁心 外 圆 上 均 布 有 雌 槽 。 定 子 相当 于 变 压 带 的 初级 ， 在 定子 槽 中 分 
别 布置 有 两 个 空间 互 成 90° 的 绕组 ， 一 个 是 定子 励磁 绕组 ,一 个 为 定子 补偿 绕组 ， 两 套 绕 组 
的 结构 是 完全 相同 的 。 在 转子 槽 中 分 别 布 置 有 两 个 空间 互 成 90" 的 绕组 ， 一 个 是 正弦 输出 绕 
组 ,一 个 是 余弦 输出 绕组 ， 两 僚 绕 组 的 结构 是 完全 相同 的 。 定 、 转 子 间 的 气 际 是 均匀 的 ， 气 
际 磁 场 一 般 为 两 极 。 定 子 纸 组 引出 线 可 直接 引出 或 接 到 固定 的 接线 板 上 ， 而 转子 绕组 引出 线 
则 通过 集 电 环 和 电 刷 引出 。 

设 定子 绕组 D,D, 轴线 和 余弦 输出 绕组 ZZ, 轴线 的 夹 角 为 G0，， 当 输出 绕组 Z 2 和 Za Zs 
以 及 定子 补偿 绕组 D;Ds 开路 ,励磁 绕组 施加 交流 励磁 电压 ws 时， 旋转 变 压 带 励磁 磁 通 D， 
在 正 、 余 弦 输 出 绕组 ZZ4 和 ZZ, 中 的 感应 电动 势 分 别 为 : 

Erni = 4.44f WDcos0 = EncosO 



































Bu = 4.4f WD, cos (0+90°) = - Er sing 

式 中 ， 及 为 励磁 绕组 和 输出 绕组 轴线 重合 时 磁 通 B, 在 该 输出 绕组 中 的 感应 电动 势 。 

硅 Bo 在 励磁 绕组 中 的 感应 电动 势 为 Eb， 则 

Ei/ Eo = 了 RAR = K, 

式 中 ， 了 本 和 配 分 别 为 输出 绕组 和 励磁 绕组 的 有 效 臣 数 ; 天, 为 变 比 或 臣 数 比 。 

则 得 En = K,E, cosb 

Po = -天 Psing 
上 式 表 明 ， 当 电源 电压 不 变 时 ， 输 出 电动 势 与 转子 转角 0 有 严格 的 正 、 人 余弦 关系 。 实 验 
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表明 ， 图 2-30 中 正弦 输出 绕组 ZZ 这 上 负载 以 后 ,在 Z324 中 有 感应 电流 产生 ,在 气 际 中 产生 相 
应 的 脉 振 磁场 B; ,旋转 变 压 具 正弦 输出 绕组 ZZ 接 上 负载 后 ,除了 存在 Ew = 一 大 En sing 


电动 势 外 ， 还 附加 了 正比 于 Bj cos 6 的 电动 势 Dy 人 Di 


其 输出 电压 不 再 是 转角 的 正弦 函数 。E, 的 出 现 破坏 
了 输出 电压 随 转角 做 正弦 变化 的 关系 ， 造 成 输出 特 








性 的 畸变 。 5 人 
补偿 的 办 法 之 一 是 ， 定 子 DsD, 绕组 也 连接 负 ER 

载 ， 使 D,D, 绕组 产生 感应 电压 和 电流 。 根 据 楞 次 定 补偿 绕组 

律 ， 该 感应 电流 所 产生 的 磁 通 是 反对 Bs 磁 通 变化 D, 

的 ， 因 而 对 肪 交 轴 磁 通 起 去 磁 作用 ， 从 而 达到 补偿 ee 

的 目的 。 一 般 只 要 把 D;D, 短路 ， 即 可 实现 补偿 。 


补偿 的 办 法 之 二 是 ,余弦 ZiZ， 绕组 接 对 称 负 输出 绕组 
载 ， 也 可 以 抵消 B, 的 影响 。 

两 种 补偿 可 以 同时 使 用 ， 以 减 小 补偿 误差 。 旋 
转变 压 器 是 一 种 交流 励磁 型 的 角度 检测 器 ， 检 测 精 
度 较 高 。 在 使 用 时 ， 可 以 把 旋转 变压器 转子 与 机 器 
人 关节 轴 连 接 ， 用 鉴 相 器 测 出 转子 感应 电动 势 的 相 
位 ， 从 而 确定 关节 旋转 的 角度 。 S00 

2. 感应 同步 器 

感应 同步 器 也 是 一 种 电磁 式 装置 的 测量 元 件 ， 工 作 原 理 与 旋转 变压器 相似 ， 按 其 结构 特 
点 不 同一 般 分 为 直线 式 和 旋转 式 两 种 。 直 线 式 感应 同步 器 由 定 尺 和 滑 尺 组 成 ;旋转 式 感应 同 
步 器 (图 2.31、 图 2-32) 由 转子 和 定子 组 成 。 前 者 用 于 直线 位 移 测量 ， 后 者 用 于 角 位 移 测 





Z2 

















图 2-31 旋转 式 感 应 同步 此 图 2-32 ”旋转 式 感应 同步 豆 原 理 图 
a) 定子 b) 转子 


在 定 尺 和 转子 上 的 是 连续 绕组 ， 在 滑 尺 和 定子 上 的 则 是 分 段 绕组 。 分 段 绕 组 分 为 两 组 ， 
布置 成 在 空间 相差 90° 相 位 ， 分 别称 为 正弦 绕组 (S 绕组 ) 和 余弦 绕组 (C 绕组 ) 。 感 应 同 
步 右 的 分 段 绕 组 和 连续 绕组 相当 于 变 压 带 的 一 次 侧 和 二 次 侧线 圈 ， 利 用 交 变 电磁 场 和 互感 原 
理工 作 。 滑 尺 或 定子 的 两 个 绕组 中 的 任 一 绕组 通 交 变 励磁 电压 时 ， 由 于 电磁 效应 ， 定 尺 或 转 
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子 绕组 上 必然 产生 相应 的 感应 电动 势 。 感 应 电动 势 的 大 小 取决 于 滑 尺 相对 定 尺 〈 或 转子 相 
对 定子 ) 的 位 置 。 以 定 尺 绕组 中 感应 电动 势 的 变化 情况 为 例 ; 滑 尺 绕组 与 定 尺 绕组 同 向 对 
齐 〈 图 2-33 中 正弦 绕组 时 ， 这 时 定 尺 绕组 中 2 2 
的 感应 电动 势 最 大 ， 如 果 滑 尺 相对 于 定 尺 向 左 
(或 右 ) 平行 移动 ， 感 应 电动 势 就 随 之 逐渐 减 
小 ， 在 两 绕组 刚好 错开 1/4 节 距 (7/2) 的 位 
置 时 ， 感 应 电动 势 减 为 零 ; 若 再 继续 移动 ， 移 
到 172 节 距 的 位 置 时 ， 两 绕组 反 向 对 齐 ， 感 应 [| 
电动 势 为 负 向 最 大 ， 当 到 达 3/4 节 距 的 位 置 时 ， 纺 Hi 一 一 区 编组 
感应 电动 势 再 一 次 变 为 零 ， 这样 ， 滑 尺 每 移动 。 。。 图 7.33 吉 线 式 感应 同步 器 原理 图 
一 个 节 距 ， 定 尺 绕组 的 感应 电动 势 大 小 周期 性 
变化 一 次 。 

3. 光电 编码 器 

光电 编码 器 是 一 种 旋转 式 位 置 传感器 ， 在 现代 伺服 系统 中 广泛 应 用 于 角 位 移 或 角 速 率 的 
测量 ， 它 的 转轴 通常 与 被 测 旋转 轴 连 接 ， 随 被 测 轴 一 起 转动 ， 能 将 被 测 轴 的 角 位 移 转换 成 二 
进 制 编码 或 一 串 脉 串 。 光 电 编 码 器 分 为 绝对 式 和 增 量 式 两 种 类 型 。 

(1) 增 量 式 光电 编码 器 

1) 增 量 式 光电 编码 器 的 结构 。 增 量 式 光电 编码 器 是 指 随 转轴 旋转 的 码 盘 给 出 一 系列 及 
冲 ， 然 后 根据 旋转 方向 用 计数 器 对 这 些 脉冲 进行 加 减 计数 ， 以 此 来 表示 转 过 的 角 位 移 量 。 增 
量 式 光电 编码 器 结构 如 图 2-34 所 示 。 光 电码 盘 与 转轴 连 在 一 起 。 码 盘 可 用 玻璃 材料 制 成 ， 
表面 贸 上 一 层 不 透 光 的 金属 铬 ， 然 后 在 边缘 制 成 向 心 的 透 光 狭 缝 。 透 光 狭 颖 在 码 盘 贺 周 上 等 
分 ， 数量 从 几 百 条 到 几 千 条 不 等 。 这 样 ， 整 个 码 盘 圆周 上 就 被 等 分 成 个 透 光 的 模 。 增 量 式 
光电 码 盘 也 可 用 不 锈 钢 薄 板 制 成 ， 然 后 在 贺 周 边缘 切割 出 均匀 分 布 的 透 光 杠 。 


























图 2-34 ” 增 量 式 光电 编码 胡 结 构 


2) 增 量 式 光电 编码 帮 的 工作 原理 。 增 量 式 光电 编码 右 的 工作 原理 如 图 2-34 所 示 。 它 由 
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码 盘 、 鉴 回 熏 、 光 学 系统 和 光电 变换 希 组 成 。 在 码 盘 〈 光 电 盘 ) 周边 刻 有 市 距 相 等 的 辐射 
状 狂笑， 形成 均匀 分 布 的 透明 区 和 不 透明 区 。 鉴 四 盘 与 码 盘 平行 ， 并 刻 有 a、b 两 组 透明 检 
测 狭 颖 ， 两 个 狭 缝 距离 是 码 盘 上 两 个 狭 缝 距离 的 /4， 以 使 A、B 两 个 光电 转换 帮 的 输出 信 
号 在 相位 上 相差 90" ， 如 图 2-35 所 示 。 工 作 时 ， 鉴 向 盘 静 止 不 动 ， 码 盘 与 转轴 一 起 转动 ， 光 
源 发 出 的 光 投 射 到 码 盘 与 鉴 问 盘 上 。 当 码 盘 上 的 不 透明 区 正好 与 鉴 癌 盘 上 的 透明 罕 缝 对齐 
时 ， 光 线 被 全 部 遮 住 ， 光 电 转换 带 输出 电压 为 最 小 ; 当 人 码 盘 上 的 透明 区 正好 与 鉴 问 盘 上 的 透 
明 罕 颖 对 齐 时 ， 光 线 全 部 通过 ， 光 电 变 换 带 莹 

输出 电压 为 最 大 。 码 盘 每 转 过 一 个 刻 线 周期 ， 
输出 信号 为 一 个 脉冲 ， 每 一 个 脉冲 对 应 一 个 





分 辨 角 qa， 对 脉冲 进行 计数 N， 就 是 对 a 的 累 “ 
加 ， 即 角 位 移 9 = aN。 
光电 编码 器 的 测量 准确 度 与 码 盘 圆周 上 广 
的 狭 颖 条 纹 数 n 有关， 能 分 辨 的 角度 w 为 "| 
360°/n， 分辨 率 为 1/n 。 例 如 ， 码 盘 边 缘 的 
透 光 槽 数 为 1024 个 ， 则 能 分 辨 的 最 小 a = 图 2.35 增 量 式 编码 器 输出 波形 图 


360°/1024 =0. 352°。, 

光敏 元 件 所 产生 的 信号 A、B 彼此 相差 90* 相 位 ， 用 于 辨 血 。 当 码 盘 正 转 时 ，A 信号 超 
前 B 信号 90°; 当 码 盘 反 转 时 ，B 信号 超前 A 信号 90 "。 在 码 盘 里 圈 ， 还 有 一 条 狭 缝 C， 每 
转 能 产生 一 个 脉冲 ， 该 脉冲 信号 又 称 “ 一 转 信号 ”或 零 标志 脉冲 ， 作 为 测量 的 起 始 基 准 。 

由 于 增 量 式 角 编 码 规 的 输出 信号 是 脉冲 形式 ， 因 此 ， 可 以 通过 测量 脉冲 频率 或 周期 的 方 
法 来 测量 转速 。 角 编码 画 可 代 符 测速 发 电机 的 模拟 测速 ， 而 成 为 数字 测速 装置 。 

根据 脉冲 计数 来 测量 转速 的 方法 有 以 下 三 种 : 

QM 法 测速 。 在 规定 时 间 内 测量 所 产生 的 脉冲 个 数 来 获得 被 测速 度 ， 称 为 M 法 测速 ; 
在 一 定 的 时 间 间 隔 友 〈 又 称 闸门 时 间 ， 如 10s、1s、0. 1s 等 ) 内 ， 用 角 编 码 器 所 产生 的 脉冲 
数 来 确定 速度 的 方法 称 为 M 法 测速 ， 其 测速 原理 如 图 2-36a 所 示 。 

右 角 编码 骨 每 转产 生 w 个 脉冲 ， 在 闸门 时 间 间 隅 六 内 得 到 mm 个 脉冲 ， 则 角 编码 带 所 产 
生 的 脉冲 频率 了 为 

















7721 
/= 一 
i, 
也 mi : . 
则 转速 nn 为 n= 一 =60 一 - (单位 为 r/min) 
N tN 
例如 某 角 编码 融 的 指标 为 2048 个 脉冲 Xr ( 即 N=2048)， 在 0.2s 时 间 内 测 得 8K 脉冲 
192 
(1K=1024), 即 1 =0.2s, m, = 8K = 8192 个 脉冲 , f = =40960Hz， 则 角 编 码 器 轴 的 
.2S 
转速 为 
f ml 8192 . . 
1 = 一 = 00 -一 = 00 xCO—r/min =1200r/min 
N tN 0. 2 x2048 








M 法 测速 主要 应 用 于 要 求 转 速 较 快 的 场合 ， 否 则 计数 值 较 少 ， 测 量 准确 度 较 低 。 
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Ci 法 测速 。 测 量 相 邻 两 个 脉冲 的 时 间 来 测量 速度 ， 称 为 T 法 测速 。T 法 测速 的 原理 是 
用 一 已 知 频率 大 〈 此 频率 一 般 都 比较 高 ) 的 时 钟 脉 冲 向 一 计数 器 发 送 脉冲 ， 计 数 硕 的 起 停 
由 码 盘 反馈 的 相 邻 两 个 脉冲 来 控制 ， 甚 测速 原理 如 图 2-36b 所 示 。 奉 计数 带 读 数 为 m,， 则 
电动 机 每 分 钟 转 数 为 





60f. ; 
n = 2 (单位 为 r/min) 
式 中 , P 为 码 盘 一 圈 发 出 的 脉冲 个 数 ， 即 码 盘 线 数 。 
T 法 适合 于 测量 较 低 的 速度 ， 这 R= 


时 能 获得 较 高 的 分 辨 率 。 本 

(MAT 法 测速 。 同 时 测量 检测 时 
间 和 在 此 时 间 内 脉冲 发 生 器 发 出 的 脉 
冲 个 数 来 测量 速度 ， 称 为 MAT 法 测 


速 。M/T 法 测速 是 将 M 法 和 了 法 两 
种 方法 结合 在 一 起 使 用 ， 在 一 定 的 时 ”输出 脉冲 


间 范 围 内 ， 同 时 对 光电 编码 内 输出 的 | 


脉冲 个 数 mi 和 1 进行 计数 。 采用 M/ 时 钟 脉冲 we 
T 法 既 具有 M 法 测速 的 高 速 优点 , 又 。 大 |。 


具有 了 T 法 测速 的 低速 优点 ， 能 够 禾 董 














EW ， b 

较 广 的 转速 范围 ,测量 的 精度 也 较 ， 

高 ， 在 电动 机 的 控制 中 有 着 十 分 广泛 图 2-36” 增 量 式 编码 测速 方法 
的 应 用 。 a) M 法 测速 b) 了 法 测速 


(2) 绝对 式 光 电 编 码 融 ”绝对 
式 光电 编码 妖 是 把 被 测 转角 通过 读 
取 码 盘 上 的 图 案 信 息 直 接 转 换 成 相 
应 代码 的 检测 元 件 ， 如 图 2-37 所 示 。 
码 盘 有 光电 式 、 接 触 式 和 电磁 式 三 
种 。 光 电 陈 码 熏 是 目前 应 用 较 多 的 
一 种 ， 它 是 在 透明 材料 的 圆 盘 上 精 
确 地 印 制 上 二 进 制 编码 。 图 2-38a 所 
示 为 四 位 二 进 制 的 码 盘 ， 码 盘 上 各 
圈 圆 环 分别 代 表 一 位 二 进 制 的 数字 
码 道 ， 在 同一 个 码 道 上 印 制 黑 日 等 
间隔 图 案 ， 形 成 一 套 编码 。 黑 色 不 透 光 区 和 白色 透 光 区 分 别 代表 二 进 制 的 “0” 和 “1”。 在 
一 个 四 位 光电 码 盘 上 ， 有 四 圈 数 字 但 道 ， 每 一 个 码 道 表 示 二 进 制 的 一 位 ， 里 侧 是 高 位 ， 外 侧 
是 低位 ， 在 360° 范 围 内 可 编码 数 为 2 =16 个 。 工 作 时 ， 码 盘 的 一 侧 放 置 电源 ， 另 一 边 放置 
光电 接收 装置 ， 每 个 码 道 都 对 应 有 一 个 光敏 管 及 放大 、 整 形 电路 。 码 盘 转 到 不 同位 置 ， 光 人 敏 
元 件 接收 光 信 号 ， 并 转 成 相应 的 电信 号 ， 经 放大 整形 后 ， 成 为 相应 数码 电信 和 号 。 

但 由 于 制造 和 安装 精度 的 影响 ， 当 人 码 盘 回 转 在 两 码 段 交 蔡 过 程 中 ， 会 产生 读数 误差 。 例 
如 ， 当 码 盘 顺 时 针 方 向 旋转 ， 由 位 置 “0111” 变 为 “1000” 时 ， 这 四 位 数 要 同时 都 变化 ， 











图 2-37 ”绝对 式 光 电 编 码 髓 
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可 能 将 数码 误 读 成 16 种 代码 中 的 任意 一 种 ， 如 读 成 1111、1011、1101、…、0001 等 ,产生 
了 无 法 估计 的 很 大 数值 误差 ， 这 种 误差 称 非 单 值 性 误差 。 为 了 消除 非 单 值 性 误差 ， 可 采用 以 
下 的 方法 : 

1) 循环 码 盘 〈 或 称 格 雷 码 盘 ) 。 循 环 码 习惯 上 又 称 格雷 码 ， 它 也 是 一 种 二 进 制 编码 ， 
只 有 “0” 和 “1” 两 个 数 。 图 2-38b 所 示 为 四 位 二 进 制 循环 码 。 这 种 编码 的 特点 是 任意 相 
邻 的 两 个 代码 间 只 有 一 位 代码 有 变化 ， 即 “0” 变 为 “1” 或 “1” 变 为 “0”。 因 此 ， 在 两 
数 变 换 过 程 中 ， 所 产生 的 读数 误差 最 多 不 超过 “1”， 只 可 能 读 成 相 邻 两 个 数 中 的 一 个 数 。 
所 以 ， 它 是 消除 非 单 值 性 误差 的 一 种 有 效 方法 。 

2) 市 判 位 光电 闭 置 的 二 进 制 循环 码 熏 。 这 种 码 盘 是 在 四 位 二 进 制 循环 码 盘 的 最 外 圈 再 
增加 一 圈 信 号 位 。 图 2-38e 所 示 就 是 市 判 位 光电 装置 的 二 进 制 循环 码 盘 。 该 码 盘 最 外 圈 上 信 
写 位 的 位 置 正好 与 状态 交 线 错 开 ， 只 有 当 信 号 位 处 的 光电 元 件 有 信号 时 才 读 数 ， 这 样 就 不 会 
产生 非 单 值 性 误差 。 

绝对 式 光电 编码 妖 测 量 精度 取决 于 它 所 能 分 辨 的 最 小 角度 ， 这 与 公 盘 上 的 码 道 数 n 有 
关 ， 即 最 小 能 分 辨 的 角度 及 分 辨 率 为 : 最 小 a =360°/2"， 分辨 率 为 1/2"。 
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图 2-38 ”四 位 码 盘 编码 示意 图 
a) 四 位 二 进 制 的 码 盘 b) 四 位 二 进 制 循环 码 盘 c) 带 判 位 光电 装置 的 二 进 制 循 环 人 码 盘 


(二 ) 速度 传感器 

速度 传 感 紫 是 机 磊 人 的 内 部 传 感 瘟 之 一 ， 用 来 确定 关 广 的 运动 速度 。 

(1) 绝对 式 光 电 编码 融 也 可 以 用 来 测量 角速度 ”因为 这 种 编码 硕 输 出 的 是 旋转 角度 的 
现时 值 ， 所 以 硅 对 单位 时 间 之 前 的 值 进行 记忆 ， 并 取 它 与 现时 值 之 间 的 差 值 ， 就 可 以 求 得 角 
速度 。 

(2) 增 量 式 码 盘 也 可 以 作为 速度 传 感 瘟 ” 当 增 量 式 码 盘 也 可 以 作为 速度 传 感 带 使 用 时 ， 
既 可 以 用 模拟 输出 ， 也 可 以 用 数字 输出 。 把 码 盘 的 脉冲 频率 转换 成 与 转速 成 正比 的 模拟 电压 
的 方法 可 得 到 模拟 输出 。 而 单位 时 间 内 的 脉冲 数 就 可 表示 这 段 时 间 的 平均 速度 ， 当 时 间 单 位 
足够 小 时 ， 则 可 以 代表 某 个 时 间 点 的 瞬时 速度 值 。 

(3) 人 磁 电 感应 式 速度 传 感 大 ”人 磁 电 感应 式 速度 传 感 郁 是 利用 导体 和 磁场 发 生 相 对 运动 
产生 感应 电动 势 ， 是 一 种 磁 电能 量变 换 型 传 感 硕 。 不 需要 供电 电源 ， 电 路 简单 ， 性 能 稳定 ， 
输出 阻抗 小 且 频 率 啊 应 范围 广 。 

变 磁 通 式 磁 电感 应 转速 传 感 希 ， 是 将 感应 电动 势 的 频率 作为 输出 ， 而 电动 势 的 频率 取决 
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于 和 磁 通 变化 的 频率 。 变 和 磁 通 式 转速 传感器 的 结构 有 开 磁 路 和 闭 磁 路 两 种 。 

如 图 2-39 所 示 为 开 磁 路 变 磁 通 式 转速 传感器 。 测 量 郁 轮 安 闭 在 被 测 转轴 上 与 其 一 起 旋 
转 。 当 齿轮 旋转 时 ， 齿 的 四 凸 引 起 磁 阻 的 变化 ， 从 而 使 磁 通 发 生变 化 ， 因 而 在 线圈 中 感应 出 
交 变 的 电动 势 ， 其 频率 秆 于 齿轮 的 齿 数 z 和 转速 n 的 乘积 ， 即 

f = zn/60 
式 中 ,，z 为 齿轮 齿 数 ; n 为 被 测 轴 转速 (vAmin); /为 感应 电动 势 频率 ( Hz)。 

这 样 当 已 知 z， 测 得 /就 可 得 出 二 值 。 

(4) 测速 发 电机 测速 发 电机 是 应 用 最 广泛 ， 能 直接 得 到 代表 转速 的 电压 上 且 具 有 恨 好 实 
时 性 的 一 种 速度 测量 传 感 带 。 测 速 发 电机 实际 上 是 一 台 小 型 永 磁 式 直 流 发 电机 ， 其 结构 原理 
如 图 240 所 示 。 其 工作 原理 基于 法 拉 第 电磁 感应 定律 ， 当 通过 线圈 的 磁 通 量 恒定 时 ,位 于 
人 磁场 中 的 线圈 旋转 使 线圈 两 端 产生 的 电压 (感应 电动 势 ) 与 线圈 (转子 ) 的 转速 成 正比 ， 
即 











u = kn 


式 中 ,为 测速 发 电机 的 输出 电压 (V) ; n 为 测速 发 电机 的 转速 (r/min) ;为 比例 系数 。 
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一 一 .、 测量 齿轮 线圈 软 铁 永久 磁铁 


O) 








图 2-39” 开 磁 路 变 磁 通 式 转速 传感器 图 240 直流 测速 发 电机 的 结构 原理 
1 一 永久 磁铁 ”2 一 转子 线圈 3 一 电 刷 4 一 整流 子 





从 式 中 看 出 ， 和 输出 电压 与 转子 转速 呈 线 性 关系 。 但 当 直 流 测速 发 电机 带 有 负载 时 ， 电 枢 
的 线圈 绕组 便 会 产生 电流 而 使 输出 电压 下 降 ， 这 样 便 破 坏 了 输出 电压 与 转速 的 线性 度 ， 使 输 
出 特性 产生 误差 。 为 了 减少 测量 误差 ， 应 使 负载 尽 可 能 小 旦 保持 负载 性 质 不 变 。 测 速 发 电机 
线性 度 好 ， 灵 敏 度 高 ， 输 出 信号 强 ， 目 前 检测 范围 一 般 为 20 ~ 40r/min， 精度 为 0.2% ~ 
0. 5%。 











二 、 外 部 传 感 希 


1. 力 或 力矩 〈 力 党 ) 传感器 

工业 机 器 人 在 进行 装配 、 搬 运 、 研 磨 等 作业 时 需要 对 工作 力 或 力矩 进行 控制 。 例 如 装配 
时 需 进 行将 轴 类 零件 插入 孔 里 ， 调 准 零 件 的 位 置 ， 拧 动 螺钉 等 一 系列 步骤 ， 在 拧 动 螺钉 过 程 
中 需要 有 确定 的 拧紧 力 ; 搬运 时 机 带 人 手 爪 对 工件 需 有 合理 的 握力 ， 握 力 太 小 不 足以 搬 动 工 
件 ， 太 大 则 会 损坏 工件 ;研磨 时 需要 有 合适 的 砂轮 进 给 力 ， 以 保证 研磨 质量 。 妇 外 ， 机 釉 人 
在 自我 保护 时 也 需要 检测 关节 和 连 杆 之 间 的 内 力 ， 防 止 机 需 人 手臂 因 厌 载 过 大 或 与 周围 障碍 
物 碰撞 而 引起 的 损坏 。 还 用 于 感知 夹 持 物体 的 状态 ; 校正 由 于 手臂 变形 引起 的 运动 误差 ， 所 
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以 力 和 力矩 传 感 融 在 机 右 人 中 的 应 用 较 广泛 ， 主 要 分 为 三 种 类 型 : 

1) 靶 在 关节 驱动 硕 上 的 力 传 感 融 ， 称 为 关节 力 传 感 天 。 用 于 控制 中 的 力 反馈 。 

2) 闭 在 末端 执行 名和 机 项 人 最 后 一 个 关节 之 间 的 力 传 感 希 ， 称 为 腕 力 传 感 硕 。 腕 力 传 
感 带 能 直接 测 出 作用 在 末端 执行 融 上 的 各 向 力 和 力矩 。 

3) 装 在 机 带 人 手 爪 指 关 广 (或 手指 上 ) 的 力 传 感 副 ， 称 为 指 力 传 感 副 。 用 来 测量 夹 持 
物体 时 的 受 力 情况 。 

机 个 人 这 三 种 力 觉 传 感 融 有 不 同 的 特点 ， 关 力 传 感 副 用 来 测量 天 市 的 受 力 (力矩) 
情况 ， 信 息 量 单一 ， 传 感 需 结构 也 比较 简单 ， 是 一 种 专用 的 力 传 感 肯 ;手指 力 传 感 希 一 般 测 
量 范围 较 小 ， 同 时 受 手 爪 尺寸 和 重量 的 限制 ， 指 力 传 感 带 在 结构 上 要 求 小 巧 ， 也 是 一 种 较 专 
用 的 力 传 感 硕 ; 腕 力 传 感 融 从 结构 上 来 说 是 一 种 相对 复杂 的 传 感 副 ， 它 能 获得 手 爪 三 个 方 癌 
的 受 力 (力矩 ), 信息 量 较 多 ， 又 由 于 其 安装 的 部 位 在 末 病 执行 融和 机 带 人 手臂 之 间 ， 比 较 
容易 形成 通用 化 的 产品 系列 。 

觉 传 感 带 第 用 的 形式 有 电阻 应 变 刻 式 、 压 电 式 、 电 容 式 、 电 感 式 以 及 各 种 外 力 传 感 
大。 它 的 原理 都 是 通过 弹性 敏感 元 件 将 被 测 力 或 力矩 转换 成 菜 种 位 移 量 或 变形 量 ， 然 后 通过 
各 日 的 敏感 介质 把 位 移 量 或 变形 量 转换 成 能 够 输出 的 电量 。 

目前 使 用 最 广泛 的 是 电阻 应 变 片 式 力 和 力矩 传 感 带 。 图 241 所 示 为 20 世纪 70 年 代 就 
研制 成 功 的 一 种 六 维 腕 力 传 感 占 。 它 由 一 只 直径 为 75mm 的 铝 管 铣削 而 成 ， 具 有 八 个 罕 长 的 
弹性 梁 ， 每 个 梁 的 贷 部 只 传递 力 ， 转 矩 作用 很 小 ， 八 个 梁 中 有 四 个 水 平 梁 和 四 个 垂直 梁 ， 每 
个 梁 发 生 的 应 变 集 中 在 梁 的 一 端 ， 把 应 变 片 贴 在 应 变 最 大 处 的 两 人 出， 硅 应 变 片 的 阻 值 分 别 为 
Ri 、R,， 则 连接 成 图 242 所 示 的 形式 输出 ， 由 于 R、R, 所 受 应 变 方 向 相反 ,Vi 输出 比 使 用 
单个 应 变 片 时 大 一 倍 ,图 241 中 从 P. 到 0,- 代 表 了 八 根 应 变 梁 的 变形 信号 的 输出 电压 。 
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图 241 六 维 腕 力 传感器 图 2-42 ”六 维 腕 力 传感器 应 变 片 连接 方式 





则 六 维 力 (力矩 ) 可 表示 为 
F,= hk(P,,.+P,.) 
fe (Ls ys) 


第 二 章 ”工业 机 器 人 的 组 成 及 工作 原理 pp 


I A 
M,= ka(Q,: -0,-) 
M, 三 ks (OQ, 二 人 
有 Ea -P,-) 
式 中 ，k ，k ,kk ，h4 ,ks ,ke 为 结构 系数 ， 由 实验 测定 。 
该 传感器 为 直接 输出 型 力 传 感 硕 ， 不 需要 再 做 运算 ， 并 能 够 进行 温度 自动 补偿 。 主 要 缺 
点 是 维 间 有 一 定 耦 合 ， 传 感 锅 弹性 染 的 加 工 难度 大 ， 而 且 刚 变 交 电流 
f 
性 较 差 。 
2. 接近 觉 传感器 
接近 觉 传 感 锅 是 机 器 人 用 来 探测 机 融 人 自身 与 周围 物体 



































之 间 相对 位 置 或 距离 的 一 种 传感器 ， 它 探测 的 距离 一 般 在 几 人 

毫米 到 十 几 厘 米 之 间 。 接 近 觉 传感器 结构 上 分 为 接触 型 和 非 

接触 型 两 种 ， 其 中 非 接触 型 接近 觉 传感器 应 用 较 广 。 目 前 按 2 

照 转换 原理 的 不 同 ， 接 近 觉 传感器 分 为 电 涡流 式 、 光 纤 式 、 

超声 波 式 及 激光 扫描 式 等 。 图 243 电 涡 流传 感 带 
(1) 电 涡流 式 传感器 “ 块 状 金属 导体 处 于 一 个 交 变 磁场 的 


中 时 ， 其 内 部 就 会 产生 涡 旋 状 的 感应 电流 。 这 种 感应 电流 称 为 电 涡流 ， 这 一 现象 称 为 电 涡 流 
现象 ， 利 用 这 一 原理 可 以 制作 电 涡 流 
传 感 吕 。 电 涡流 传 感 硕 的 工作 原理 如 待 检测 物体 
图 243 所 示 。 电 涡流 传 感 希 通过 通 有 


单 向 光纤 束 
交 变 电 流 的 线圈 向 外 发 射 高 频 变化 的 电 “| 发 射 器 - 
磁场 ， 处 在 磁场 周围 的 被 测 导电 物体 就 | 至 《 迪 、 


产生 了 电 涡 流 。 由 于 传感器 的 电磁 场 方 。 ” 拉 制 i 

向 与 产生 的 电 涡流 方向 相反 ， 两 个 磁场 9 

相互 全 加 前 弱 了 传 感 妖 的 电感 和 阻抗 。 

用 电路 把 传感器 电感 和 阻抗 的 变化 转换 站 上 san 
成 转换 电压 ， 则 能 计算 出 目标 物 与 传 感 


器 之 间 的 距离 。 该 距离 正比 于 转换 电 -一 一 
压 ， 但 存在 一 定 的 线性 误差 。 对 于 钢 或 Y 形 光纤 来 











回 射 革 
馈 等 材料 的 目标 物 ， 线性 度 误差 为 。 控制 b) 
+0.5%, 





(2) 光纤 式 传 感 絮 ”光纤 是 一 种 
新 型 的 光电 材料 ， 在 远 距 离 通信 和 遥测 
方面 应 用 广泛 。 用 光纤 制作 接近 党 传 感 
船 可 以 用 来 检测 机 釉 人 与 目标 物 间 较 远 














的 距离 。 这 种 传感器 具有 抗 电磁 王 扰 能 o 
力 强 、 灵 敏 度 高 、 响 应 快 的 特点 。 光 纤 图 2-44 ”光纤 传感器 原理 图 
式 传 感 右 有 三 种 不 同 的 形式 。 第 一 种 为 a) 射 束 中 断 型 光纤 传感器 、b) 回 射 型 光纤 传感器 


射 束 中 断 型 ， 如 图 2-44a 所 示 。 这 种 光 c) 扩散 型 光纤 传感器 
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纤 传 感 希 如 果 光 发 射 句 和 接收 需 通 路 中 的 光 被 谴 断 ， 则 说 明 通 路 中 有 物体 存在 ， 传 感 顺 便 能 
检测 出 该 物体 。 这 种 传感器 只 能 检测 出 不 透明 物体 ， 对 透明 或 半 透 明 的 物体 无 法 检测 。 第 
二 种 为 回 射 型 ， 如 图 2-44b 所 示 。 不 透 光 物体 进入 Y 形 光纤 束 示 端 和 度 体 之 间 时 ， 到 达 接 
收 需 的 反射 光 强 度 大 为 减弱 ， 故 可 检测 出 光 通 路 上 是 否 有 物体 存在 。 与 第 一 种 类 型 相 比 ， 
这 一 种 类 型 的 光纤 式 传 感 硕 可 以 检测 出 透 光 材料 制 成 的 物体 。 第 三 种 为 扩散 型 ， 如 图 2- 
44c 所 示 。 与 第 二 种 相 比 第 三 种 少 了 回 射 靶 。 因 为 大 部 分 材料 都 能 反射 一 定量 的 光 ， 这 种 
类 型 可 检测 透 光 或 半 透 光 物 体 。 

(3) 超声 波 式 传感器 ”超声 波 接近 沉 传 感 锅 是 利用 超声 波 测 量 距 离 。 声 波 传输 需要 一 定 
的 时 间 ， 其 时 间 与 超声 波 的 传播 速度 和 距离 成 正比 ， 故 只 要 测 出 超声 波 到 达 物 体 的 时 间 ， 就 
能 得 到 距离 值 。 

超声 波 传 感 融 测 距 原理 图 如 图 245 所 示 。 传 感 器 由 一 个 超声 波 发 射 锅 、 一 个 超声 波 接 
收 怖 、 定 时 电路 及 控制 电路 组 成 。 竺 超声波 发 射 锅 发 出 脉冲 式 超 声波 后 关闭 发 射 句 ， 同 时 打 
开 超声 波 接收 需 。 该 脉冲 波 到 达 物 体 表 面 后 返回 到 接收 硕 ， 定 时 电路 测 出 从 发 射 右 发 射 到 接 
收 需 接收 的 时 间 。 设 该 时 间 为 了， 而 声波 的 传输 速度 为 "， 则 被 测 距 离 志 为 

7 
2 

超声 波 的 传输 速度 与 其 波长 和 频率 成 正比 ， 只 要 这 两 者 被 测 物体 
不 变 ， 速 度 就 为 常数 ， 但 随 着 环境 温度 的 变化 ， 波 速 会 有 一 
定 变 化 。 

超声 波 传 感 絮 对 于 水 下 机 器 人 的 作业 非常 重要 。 水 下 机 
器 人 安装 超声 波 传 感 硕 后 能 使 其 定位 精度 达到 微米 级 。 另 
外 ， 激光 扫 描 型 接近 觉 传 感 需 的 测量 原理 与 超声 流传 感 大 类 
似 。 






































3. 触觉 传感器 ~ 
一 般 认 为 触 党 包括 接触 党 、 压 党 、 谐 党 、 力 党 四 种 ， 狭 图 2-45 ”超声波 传感器 
义 的 触 党 按 字 面 上 来 看 是 指 前 三 种 感知 接触 的 感 党 。 测 距 原理 图 

















(1) 接触 觉 传 感 医 ”接触 觉 传 感 副 是 指 汉 在 手 扑 上 以 判断 是 否 接 触 物体 为 基本 特征 的 
测量 传 感 带 。 根 据 触 觉 传 感 紫 的 输出 ， 机 各 人 可 以 感受 和 搜索 对 象 物 ， 感受 手 爪 与 对 象 物 之 
间 的 相对 位 置 和 姿态 ， 并 修正 手 爪 的 操作 状态 。 采 用 分 布 密 度 比 较 高 的 接触 觉 传 感 融 ， 还 可 
以 判断 对 象 物 的 大 致 几何 形状 。 

微 动 开 关 、 光 敏 开 关 可 作为 一 种 最 简单 的 触觉 传 感 副 ， 装 在 机 带 人 手 丰 的 前 端 及 内 外 
侧 ， 或 相当 手 党 心 的 部 分 ， 通 过 其 电 接点 的 通 断 信号 实现 检测 功能 。 这 种 传 感 硕 价格 便宜 ， 
实用 可 靠 ， 连接 方便 。 男 外 用 吸盘 吸 住 物体 进行 搬运 作业 时 ， 还 可 以 通过 真空 压力 开关 信和 号 
检测 吸盘 是 否 吸 住 搬 运 物 ， 当 表面 作用 有 超过 阐 值 的 压力 时 ， 传 感 带 输出 一 个 电信 号 ， 在 人 码 
过 或 上 下 料 等 搬运 作业 中 经 常用 到 。 

采用 柔性 导体 〈 如 导电 橡胶 、 碳 和 素 纤 维 ) 和 和 柔性 绝缘 体 为 基本 材料 构成 的 传感器 如 图 
2-46 所 示 ， 其 工作 原理 是 : 在 电极 和 和 柔性 导体 之 间 留 有 间 际 ， 当 施加 外 力作 用 时 ， 受 压 部 
分 的 柔性 导体 和 和 柔性 绝缘 体 发 生变 形 ， 利 用 柔性 导体 和 电极 间 的 接 通 状态 而 形成 接触 党 。 这 
种 传 感 硕 的 特点 是 可 以 提高 触 点 密度 ， 和 柔性 好 ， 甚 至 可 以 安 冯 在 曲面 形 手 党 上 。 
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电极 基板 ( 非 导体 ) 
a) b) 
图 2-46 ”接触 觉 传 感 融 的 结构 原理 图 
a) 结构 示意 图 b) 作用 原理 图 


(2) 压 觉 传感器 、 压 觉 传 感 器 是 以 检测 机 器 人 与 作业 对 象 之 间接 触 面 法 向 压力 值 大 小 
和 压力 分 布 的 传感器 。 可 分 为 单一 输出 值 压 觉 传感器 和 多 输出 值 的 分 布 式 压 觉 传感器 。 它 有 
助 于 机 器 人 对 接触 对 象 的 几何 形状 和 硬度 的 识别 。 对 于 易 碎 、 易 变形 的 物体 ， 必 须 使 用 压 沉 
传感器 来 对 把 持 力 进 行 控制 。 

压 觉 传感器 的 敏感 元 件 可 由 各 类 压 敏 导电 株 胶 。 电阻 压 点 电机 
材料 制 成 ， 党 用 的 有 压 敏 导电 橡胶 、 由 碳 
纤维 烧结 而 成 的 丝 状 碳 素 纤 维 片 和 强 状 导 
电 橡胶 的 排列 面 等 。 图 247 所 示 为 以 压 敏 ” 电 
导电 橡胶 为 基本 材料 的 压 觉 传感器 。 在 导 ” 久 
电 橡胶 上 面 附 有 柔性 保护 层 ， 下 部 装 有 玻 
璃 纤维 保护 环 和 金属 电极 。 在 外 压力 作用 六 
下 ， 导 电 橡胶 电阻 发 生变 化 ， 使 基底 电极 “二 二 = 二 和 
电流 相应 变化 ， 从 而 检测 出 与 压力 成 一 定 图 2.47 高 密度 分 布 式 压 党 传感器 原理 图 
关系 的 电信 号 及 压力 分 布 情况 。 通 过 改变 导电 橡胶 的 渗入 成 分 ， 可 控制 电阻 的 大 小 。 例 如 渗 
入 石墨 可 加 大 电阻 ， 渗 碳 、 渗 镍 可 减 小 电阻 。 通 过 合理 选材 和 加 工 可 制 成 高 密度 分 布 式 压 党 
传感器 。 这 种 传感器 可 以 测量 细微 的 压力 分 布 及 其 
恋 化 ， 故 有 人 称 之 为 “人 工 皮肤 ”。 

(3) 滑 觉 传感器 “ 滑 觉 传感器 用 于 判断 和 测量 
机 器 人 抓 担 或 搬运 物体 时 物体 所 产生 的 滑 移 。 按 有 
无 滑动 方向 检测 功能 可 分 为 无 方向 性 、 单 方向 性 和 
全 方向 性 三 类 。 

1) 无 方向 性 传感器 有 探 针 耳 机 式 ， 它 由 蓝宝石 
探 针 、 人 金属 缓冲 器 、 压 电 罗 谢 尔 赴 晶体 和 橡胶 缓冲 
器 组 成 。 滑 动 时 探 针 产生 振动 ， 由 罗 谢 尔 盐 转 换 为 
相应 的 电信 号 。 缓 冲 器 的 作用 是 减 小 噪声 。 

2) 单方 向 性 传感器 有 滚 简 光 电 式 ， 被 抓 物 体 的 
滑 移 使 滚筒 转动 ， 导 致 光敏 二 极 管 接收 到 透 过 码 盘 
( 装 在 滚 简 的 圆 面 上 ) 的 光 信和 号， 通过 滚筒 的 转角 
言 号 而 测 出 物体 的 滑动 。 图 248 球形 清 党 传 感 涡 
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3) 全 方向 性 传感器 采用 表面 包 有 绝缘 材料 并 构成 经 纬 分 布 的 导电 与 不 导电 区 的 金属 球 
(图 2-48) 。 当 传感器 接触 物体 并 产生 滑动 时 ， 球 发 生 转 动 ， 使 球面 上 的 导电 与 不 导电 区 交 
替 接触 电极 ， 从 而 产生 通 断 信号 ， 通 过 对 通 断 信号 的 计数 和 判断 可 测 出 滑 移 的 大 小 和 方向 。 
这 种 传感器 的 制作 工艺 要 求 较 高 。 

4. 视觉 传感器 

视觉 传感器 是 将 景物 的 光 信号 转换 成 电信 号 的 器 件 。 对 于 机 器 人 视觉 系统 来 说 ， 视 觉 传 
感 器 只 是 这 个 系统 中 的 一 个 组 成 部 分 。 大 多 数 机 器 人 视觉 都 不 必 通 过 胶卷 等 媒介 物 ， 而 是 直 
接 把 景物 摄 和 人 人。 过 去 经 常 使 用 光 导 摄像 等 电视 摄像 机 作为 机 器 人 的 视觉 传感器 ， 近 年 来 开发 
了 CCD (电荷 耦合 器 件 ) ， 是 一 种 MOS (金属 氧化 物 半导体 ) 结构 的 新 型 固体 视觉 传感器 。 
固体 传感器 又 可 以 分 为 一 维 线性 传感器 和 二 维 线性 传感器 ， 目 前 二 维 线性 传感器 已 经 能 做 到 
4000 个 像素 以 上 。 由 于 固体 视觉 传感器 具有 体积 小 、 重 量 轻 等 优点 ， 因 此 应 用 日 趋 广泛 。 

(1) CCD 原理 ”一 个 完整 的 CCD 器 件 由 光敏 单元 、 转 移 顶 、 移 位 寄存 器 及 一 些 辅助 输 
入 、 输 出 电路 组 成 。 光 敏 单元 简称 为 “像素 ”或 “ 像 点 "， 它 们 本 身 在 空间 上 、 电 气 上 是 和 披 
此 独立 的 。 国 体 图 像 传 感 器 利用 光敏 单元 的 光电 转换 功能 将 投射 到 光敏 单元 上 的 光学 图 像 转 
换 成 电信 号 “图 像 ”， 即 将 光 强 的 空间 分 布 转换 为 与 光 强 成 比例 的 、 大 小 不 等 的 电荷 包 空 间 
分 布 。CCD 工作 时 ， 在 设 定 的 积分 时 间 内 ， 光 敏 单元 对 光 信 号 进行 电荷 量 的 转换 ， 取 样 结 
束 后 ， 各 光敏 单元 的 电荷 在 转移 栅 信号 驱动 下 ， 转 移 到 CCD 内 部 的 移 位 寄存 器 相应 单元 中 。 
移 位 寄存 器 在 驱动 时 钟 的 作用 下 ， 将 信号 电荷 顺 次 转移 到 输出 端 ， 形 成 一 系列 幅 值 不 等 的 时 
序 脉冲 序列 ， 脉 冲 的 顺序 可 以 反映 一 个 光敏 单元 的 位 置 。 输 出 信和 号 可 接 到 示波器 、 图 像 显 示 
器 或 其 他 信和 号 存储 、 处 理 设备 中 ， 可 对 信和 号 再 现 或 进行 存储 处 理 。 

(2) CCD 图 像 传 感 器 的 分 类 ”CCD 图 像 传感器 分 为 一 维 ( 线 阵 ) CCD 和 二 维 ( 面 阵 ) 
CCD 。 

一 维 〈 线 阵 ) CCD 由 一 列 MOS 光敏 元 和 一 列 移 位 寄存 器 并 行 构成 。 光 人 敏 单元 和 移 位 寄 
存 器 之 间 有 一 个 转移 控制 栅 (1024 位 线 阵 ) ， 由 1024 个 光敏 元 、1024 个 读 出 移 位 寄存 器 组 
成 。 读 出 移 位 寄存 器 的 输出 端 Ga 一 位 一 位 的 输出 信息 ， 这 一 过 程 是 一 个 串 行 输出 过 程 。 

二 维 ( 面 阵 ) CCD 由 感光 区 、 信 号 存储 区 和 输出 \ 
转移 部 分 组 成 。 目 前 存在 三 种 典型 结构 形式 。 用 得 最 
多 的 一 种 结构 形式 为 一 列 感光 单元 ， 一 列 不 透 光 的 存 
储 单元 交替 排列 ， 如 图 249 所 示 。 在 感光 区 光敏 元 件 
积分 结束 时 ， 转 移 控制 机 打开 ， 电 荷 信 号 进入 存储 
区 。 随 后 ， 在 每 个 水 平 回 扫 周 期 内 ， 存 储 区 中 整个 电 
荷 图 像 一 次 一 行 地 向 上 移 到 水 平 读 出 移 位 寄存 器 中 。 
接着 这 一 行 电 荷 信号 在 读 出 移 位 寄存 器 中 向 右 移 位 到 
答 出 器 件 ， 形 成 视频 信和 号 输出 。 这 种 结构 的 器 件 操作 ”图 249 CCD 光敏 单元 显 微 照 片 
简单 ， 但 单元 设计 复杂 ， 感 光 单元 面积 减 小 ， 图 像 清 晰 。 固 态 图 像 传感器 与 普通 的 图 像 传 感 
器 比 ， 具 有 体积 小 、 失 真 小 、 灵 敏 度 高 、 抗 振动 、 耐 潮湿 、 成 本 低 的 特点 。 这 些 特色 决定 了 
它 可 以 广泛 用 于 自动 控制 和 自动 测量 系统 中 ， 尤 其 适用 于 图 像 识 别 技术 中 。 
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工业 机 副 人 运动 的 控制 就 是 控制 机 右 人 各 连 杆 、 各 关 方 等 彼此 之 间 的 相对 位 置 和 各 连 
杆 、 各 关节 的 运动 速度 以 及 输出 力 的 大 小 ， 这 涉及 各 连 杆 、 各 关 有 、 作 业 工 具 、 作 业 对 和 象 、 
工作 人 台 及 参考 基准 等 彼此 之 间 的 相对 位 置 的 关系 。 因 此 ， 本 章 对 机 融 人 位 姿 描述 和 坐标 变换 
进行 分 析 ， 设 置 机 船 人 各 连 杆 坐标 系 ， 确 定 各 连 杆 的 齐 次 坐标 变换 和 矩阵， 建立 机 天 人 的 运动 
学 方程 。 

工业 机 各 人 运动 学 主要 包括 正 问 运动 学 和 反 向 运动 学 两 类 。 正 癌 运 动 学 是 在 已 知 各 个 关 
节 变 量 的 前 担 下， 解决 如 何 建立 工业 机 需 人 运动 学 方程 ， 以 及 如 何 求解 手 部 相对 固定 坐标 系 
位 姿 的 问题 。 反 向 运动 学 则 是 在 已 知 手 部 要 到 达 目 标 位 姿 的 前 提 下 ， 解决 如 何 求 出 关 市 变量 
的 问题 。 反 问 运 动 学 也 称 为 求 运动 学 逆 解 。 

工业 机 做 人 相 邻 连 杆 之 间 的 相对 运动 不 是 旋转 运动 ， 束 是 平移 运动 ， 这 种 运动 体现 在 连 
接 两 个 连 杆 的 关 市 上 。 物 理 上 的 旋转 运动 或 平移 运动 在 数学 上 可 以 用 和 矩阵 代数 来 表达 ， 这 种 
表达 称 之 为 坐标 变换 。 与 旋转 和 运动 对 应 的 是 旋转 变换 ， 与 平移 运动 对 应 的 是 平移 变换 。 坐 标 
系 之 间 的 运动 关系 可 以 用 矩阵 之 间 的 乘法 运算 来 表达 。 用 坐标 变换 来 描述 坐标 系 〈 刚 体 ) 
之 间 的 运动 天 系 是 工业 机 带 人 运动 学 分 析 的 基础 。 
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一 、 机 器 人 的 机 构 


机 械 手 型 的 机 仑 人 具有 多 个 自由 度 (DOF)， 并 有 三 维 开 环 链 式 机 构 。 在 具有 单 自由 度 的 
系统 中 ， 当 变量 设 定 为 特定 值 时 ， 机 人 各 人 机 构 就 完全 确定 了 ， 所 有 其 他 变量 也 就 随 之 而 定 。 如 
图 3-1 所 示 的 四 杆 机 构 ， 当 曲柄 转角 设 定 为 120" 时 ， 则 连 杆 与 播 杆 的 角度 也 就 确定 了 。 然 而 在 
一 个 多 自由 度 机 构 中 ， 只 有 独立 设 定 所 有 的 输入 变量 ， 才 能 知 逢 其 余 的 参数 。 机 需 人 就 是 这 样 
的 多 自由 度 机 构 ， 只 有 知道 每 一 关节 变量 ， 才 能 知道 机 稚 人 的 手 处 在 什么 位 置 。 

如 采 机 和 带 人 有 要 在 空间 运动 ， 那 么 机 齿 人 束 需 要 具有 三 维 的 结构 。 虽 然 也 可 能 有 二 维 多 目 
由 度 的 机 需 人 ， 但 它们 并 不 篆 见 。 机 硕 人 是 开 环 机 构 ， 它 与 财 环 机 构 不 同 〈 例 如 四 杆 机 
构 ) ， 即 使 设 定 所 有 的 关节 变量 ， 也 不 能 确保 机 需 人 的 手 准确 地 处 于 给 定 的 位 置 。 这 是 因为 
如 果 关 蔬 或 连 杆 有 丝毫 的 俩 差 ， 该 关节 之 后 的 所 有 关 布 的 位 置 都 会 改变 且 没 有 反馈 。 例 如 ， 
在 图 3-1 所 示 的 四 杆 机 构 中 ， 如 采 连 杆 48B 侦 移 ， 它 将 影响 0,B 杆 。 而 在 开 环 系统 中 (例如 
机 各 人 )， 由 于 没有 有 反馈， 之 后 的 所 有 构件 都 会 发 生 偏 移 。 于是， 在 开 环 系统 中 ， 必 须 不 断 
测量 所 有 关节 和 连 杆 的 参数 ， 或 者 监控 系统 的 末端 ， 以 便 知 道 机 融 的 运动 位 置 。 通 过 比较 如 
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图 3-2 所 示 的 两 个 连 杆 机 构 的 向 量 方程 ， 可 以 表示 出 这 种 差别 ， 该 向 量 方程 表示 了 不 同 连 杆 
之 间 的 关系 。 








OA+AB=0,0, +0,B Cel 
OA+AB+BC=0.C 全 
可 见 ， 如 采 连 杆 4B 偏 移 ， 连 杆 0,B 也 会 相应 地 移动 ， 式 . 


(3-1) 的 两 边 随 连 杆 的 变化 而 改变 。 而 另 一 方面 ， 如 果 机 器 人 的 
连 杆 4B 偏 移 ， 所 有 的 后 续 连 杆 也 会 移动 ， 除 非 0,C 有 其 他 方法 
测量 ， 知 则 这 种 变化 是 未 知 的 。 

为 了 弥补 开 环 机 器 人 的 这 一 缺陷 ， 机 器 人 手 的 位 置 可 由 类 
似 摄像 机 的 装置 来 进行 不 断 测量 ， 于 是 机 器 人 需 借 助 外 部 手段 
( 比如 辅助 手臂 或 激光 束 ) 来 构成 闭环 系统 。 或 者 按照 常规 做 法 ， 人 FH” 了 @7 
也 可 通过 增加 机 器 人 连 杆 和 关节 强度 来 减少 偏 移 ， 采 用 这 种 方 。 训 3| 训 丰 纪 向 由 应 
法 将 导致 机 器 人 重量 重 、 体 积 大 、 动 作 慢 , 而且 它 的 额定 负载 。 。 周 环 的 四 村 机 构 
与 实际 负载 相 比 非常 小 。 


二 、 空 间 上 点 的 表示 
空间 点 P( 图 3-3) 可 以 用 它 相对 于 参考 坐标 系 的 三 个 坐标 来 表示 ， 即 
P=ai+tb,j+ck (3-3) 


其 中 ，a,，6,，c; 是 参考 坐标 系 中 表示 该 点 的 坐标 。 显 然 ， 也 可 以 用 其 他 坐标 来 表示 空 
间 操 的 位 置 。 
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a) b) 
图 3-2” 连 杆 机 构 图 3-3 空间 点 的 表示 


a) 闭 环 机 构 b) 开 环 机 构 


三 、 空 间 点 向 量 表 示 


癌 量 可 以 由 三 个 起 始 和 终止 的 坐标 来 表示 。 如 来 一 个 癌 量 起 始 于 点 4， 终止 于 点 B， 那 
么 它 可 以 表示 为 了 或 4B =(B, -4.)i+(B, -4,)j+ (B.-A4.)k。 特 殊 情 况 下 ， 如 果 一 个 向 量 
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起 始 于 原点 (图 3-4) ， 则 有 
P=ait+tb,j+tck (3-4) 
式 中 ，a,，b,，c; 是 该 向 量 在 参考 坐标 系 中 的 三 个 分 量 。 
实际 上 ， 前 一 闻 的 点 了 就 是 用 连接 到 该 点 的 问 量 来 
表示 的 ， 具 体 地 说 ， 也 就 是 用 该 向 量 的 三 个 坐标 来 表示 
的 。 
问 量 的 三 个 分 量 也 可 以 写成 矩阵 的 形式 ， 如 式 (3- 
5) 所 示 。 在 本 书 中 将 用 这 种 形式 来 表示 运动 分 量 ， 即 





























CQ: 
P=|%, (3-5) 
c- 图 34 ”空间 向 量 的 表示 


这 种 表示 法 也 可 以 稍 做 变化 ， 加 入 一 个 比例 因子 w， 如 果 *，y，z 各 除 以 w， 则 得 到 a,， 
5,，c,。 于 是 ， 这 时 向 量 可 以 写 为 
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P=| | 其 中 心 = 一 已 = 二 ，…: (3-6) 
ZZ WwW Ww 
Ww 


变量 w 可 以 为 任意 数 ， 而 且 随 着 它 的 变化 ， 向 量 的 大 小 也 会 发 生变 化 ， 这 与 在 计算 机 
图 形 学 中 缩放 一 张 图 片 十 分 类 似 。 随 着 史 值 的 改变 ,向量 的 大 小 也 相应 地 变化 。 如 果 w 大 
于 1， 向 量 的 所 有 分 量 都 变 大 ; 如 果 w 小 于 1， 向 量 的 所 有 分 量 都 变 小 。 

如 条 双 是 1， 各 分 量 的 大 小 保持 不 变 。 但 是 ， 如 果 风 =0，o， 久 ，c: 则 为 无 穷 大 。 在 这 
种 情况 下 , x, y 和 z( 以 及 a,，b,，c,) 表 示 一 个 长 度 为 无 穷 大 的 向 量 ， 它 的 方向 即 为 该 丫 量 
所 表示 的 方向 。 这 就 意味 着 方 癌 回 量 可 以 由 比例 因子 w =0 的 向 量 来 表示 ， 这 里 向 量 的 长 度 
并 不 重要 ， 而 其 方向 由 该 向 量 的 三 个 分 量 来 表示 。 


四 、 工 业 机 器 人 坐标 系 


(一 ) 坐标 系 在 固定 参考 坐标 系 原 点 的 表示 

一 个 中 心 位 于 参考 坐标 系 原 点 的 坐标 系 由 三 个 向 量 表示 ， 通 常 这 三 个 向 量 相互 垂直 ， 称 
为 单位 向 量 n，o，a， 分 别 表示 法 线 (Normal) 、 指 向 ( Orientation ) 和 接近 (Approach ) 回 量 (图 
3-5)。 如 前 所 述 ， 每 一 个 单位 向 量 都 由 它们 所 在 参考 坐标 系 的 三 个 分 量 表示 。 这 样 ， 坐 标 系 
可 以 由 三 个 向 量 以 矩阵 的 形式 表示 为 









































下 =|7 oa (3-7 ) 


(二 ) 坐标 系 在 固定 参考 坐标 系 中 的 表示 

如 条 一 个 坐标 系 不 在 固定 参考 坐标 系 的 原点 (实际 上 也 可 包括 在 原点 的 情况 ) ， 那 么 该 
坐标 系 的 原点 相对 于 参考 坐标 系 的 位 置 也 必须 表示 出 来 。 为 此 ， 在 该 坐标 系 原点 与 参考 坐标 
系 原点 之 间 做 一 个 向 量 来 表示 该 坐标 系 的 位 置 (图 3-6)。 这 个 向 量 由 相对 于 参考 坐标 系 的 三 
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个 向 量 来 表示 。 这 样 ， 这 个 坐标 系 就 可 以 由 三 个 表示 方向 的 单位 向 量 以 及 第 四 个 位 置 向 量 来 
表示 。 


F= , 2 (3-8) 
n 0, a, PP 
0 0 0 1 





Xx 了 Xx 


图 3-5 ”坐标 系 在 参考 坐标 系 原点 的 表示 图 3-6 一 个 坐标 系 在 为 一 个 坐标 系 中 的 表示 











如 式 (3-8) 所 示 ， 前 三 个 回 量 是 w =0 的 方向 回 量 ， 表 示 该 坐标 系 的 三 个 单位 向 量 n，o， 
a 的 方向 ， 而 第 四 个 w=1 的 向 量 表示 该 坐标 系 原点 相对 于 参考 坐标 系 的 位 置 。 与 单位 向量 
不 同 ,向 量 P 的 长 度 十 分 重要 ， 因 而 使 用 比例 因子 为 1。 坐 标 系 也 可 以 由 一 个 没有 比例 因子 
的 3 x4 和 矩阵 表示 ， 但 不 常用 。 


五 、 齐 次 变换 和 矩阵 


由 于 各 种 原因 ， 变 换 矩 阵 应 写成 方形 形式 ，3 x3 或 4x4 均 可 。 首 先 ， 如 后 面 看 到 的 ， 
计算 方形 矩阵 的 首要 比 计算 长 方形 矩阵 的 逆 容 易 得 多 。 其 次 ， 为 使 两 矩阵 相 乘 ， 它 们 的 维 数 
必须 匹配 ， 即 第 一 矩阵 的 列 数 必须 与 第 二 和 矩阵 的 行 数 相 同 。 如 果 两 矩阵 是 方 阵 ， 则 无 上 述 要 
求 。 由 于 要 以 不 同 顺序 将 许多 怎 阵 乘 在 一 起 得 到 机 希 人 运动 方程 ， 因 此 ， 应 采用 方 阵 进 行 计 
算 。 

为 保证 所 表示 的 矩阵 为 方 阵 ， 如 末 在 同一 矩阵 中 既 表示 姿态 又 表示 位 置 ， 那么 可 在 矩阵 
中 加 入 比例 因子 使 之 成 为 4x4 和 矩阵。 如 果 只 表示 姿态 ， 则 可 去 折 比 例 因子 得 到 3 x3 矩阵， 
或 加 入 第 四 列 全 为 0 的 位 置 数 据 以 保持 矩阵 为 方 阵 。 这 种 形式 的 矩阵 称 为 齐 次 矩阵 ， 它 们 写 
为 




















L339) 


(一 ) 平移 变换 
如 果 一 坐标 系 ( 它 也 可 能 表示 一 个 物体 ) 在 空间 以 不 变 的 姿态 运动 ,那么 该 坐标 就 是 纯 
平移 。 在 这 种 情况 下 ， 它 的 方向 单位 回 量 保持 同一 方向 不 变 。 所 有 的 改变 只 是 坐标 系 原点 相 
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对 于 参考 坐标 系 的 变化 ， 如 图 3-7 所 示 。 相 对 于 固定 参考 坐标 系 的 新 的 坐标 系 的 位 置 可 以 用 
原来 坐标 系 的 原点 位 置 问 量 加 上 表示 位 移 的 向 量 求 得 。 寿 用 矩阵 形式 ， 新 坐标 系 的 表示 可 以 
通过 坐标 系 左 乘 变换 矩阵 得 到 。 由 于 在 纯 平移 中 方向 向 量 不 改变 ， 变 换 和 矩阵 了 可 以 简单 地 
表示 为 














1 0 0 4 
0 1 0 

T= (3-10) 
0 0 1 da. 
0 .00 1 





其 中 ，d, ，d,，d, 是 纯 平 移 向 量 d 相对 于 参考 坐 
标 系 *，y，z 轴 的 三 个 分 量 。 可 以 看 到 ， 和 矩阵 的 
前 三 列表 示 没 有 旋转 运动 (等 同 于 单位 阵 ) ， 而 














后 二 :3 -es 3-7 ”坐标 轴 平 移 变换 各 点 的 坐标 
最 后 一 列表 示 平移 运动 。 新 的 坐标 系 位 置 为 ER 
二 0 1 0 dln, o, a, p, | 有 0 0 Py + (311) 
| 0 0 1 d, 1: 0, Q, pp: n, 0 a, pp: + d, 
0 00 1 人 0 0 0 1 0 0 1 
这 个 方程 也 可 用 符号 写 为 
FP. = Trans(d ,d,,d.) FPF, (3-12) 


首先 ， 如 前 面 所 看 到 的 ， 新 坐标 系 的 位 置 可 通过 在 坐标 系 和 矩阵 前 面 左 乘 变 换 矩 阵 得 到 ， 
后 面 将 看 到 ， 无 论 以 何 种 形式 ， 这 种 方法 对 于 所 有 的 变换 都 成 立 。 其 次 可 以 注意 到 ， 方 向 向 
量 经 过 纯 平移 后 保持 不 变 。 但 是 ， 新 的 坐标 系 的 位 置 是 d 和 pp 向 量 相 加 的 结果 。 最 后 应 该 注 
意 到 ， 章 次 变换 矩阵 与 矩阵 乘法 的 关系 使 得 到 的 新 矩阵 的 维 数 和 变换 前 相同 。 

(二 ) 绕 轴 纯 旋 转变 换 的 表示 

为 简化 绕 轴 旋 转 的 推导 ， 首 先 假设 该 坐标 系 位 于 参考 坐标 系 的 原点 并 且 与 之 平行 ， 之 后 
将 结果 推广 到 其 他 的 旋转 以 及 旋转 的 组 合 。 

假设 坐标 系 (n，o，a) 位 于 参考 坐标 系 (x，y，z) 的 原点 ， 坐 标 系 (n，o，a) 绕 参考 坐标 
系 的 x 轴 旋 转 一 个 角度 9， 青 假设 旋转 坐标 系 (n，o，a) 上 有 一 点 了 相对 于 参考 坐标 系 的 坐 
标 为 (P,，P,，P,) ， 相 对 于 运动 坐标 系 的 坐标 为 (P,，P,，P,)。 当 坐标 系 绕 x 轴 旋 转 时 ， 
坐标 系 上 的 点 P 也 随 坐 标 系 一 起 旋转 。 在 旋转 之 前 ,，P 点 在 两 个 坐标 系 中 的 坐标 是 相同 的 
(这 时 两 个 坐标 系 位 置 相 同 ， 并 且 相 互 平行 )。 旋 转 后 ， 该 点 坐标 ( P,，P,，P, ) 在 旋转 坐标 
系 (x*，y，z) 中 保持 不 变 , 但 在 参考 坐标 系 中 P,，P,，P, 却 改变 了 (图 3-8)。 现 在 要 求 找 到 
运动 坐标 系 旋转 后 P 相对 于 固定 参考 坐标 系 的 新 坐标 。 

从 x 轴 来 观察 在 二 维 平面 上 同一 点 的 坐标 ， 图 3-8 显示 了 点 已 在 坐标 系 旋 转 前 后 的 坐 
标 。 点 了 相对 于 参考 坐标 系 的 坐标 是 (P,，P,，P,) ， 而 相对 于 旋转 坐标 系 ( 点 尸 所 固 连 的 坐 
标 系 ) 的 坐标 仍 为 (P,，P,，P,)。 由 图 3-9 可 以 看 出 ，P, 不 随 坐 标 系 统 x 轴 的 转动 而 改变 ， 
而 P, 和 P, 却 改变 了 ， 可 以 证 明 
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Pp.=P, 
P,=L -b=P,cos0 -Psinb (3-13) 
P,=ls +ls =P,sing + P,cosO 





a) b) 


图 3-8 在 坐标 系 旋转 前 后 的 点 的 坐标 
a) 旋转 前 b) 旋 转 后 


写成 矩阵 形式 为 
P, 1 0 0 0 
上 =|0 cos -sing | P, (3-14) 
J 0 sing cos A\P, 
可 见 ， 为 了 得 到 在 参考 坐标 系 zh 


中 的 坐标 ， 旋 转 坐 标 系 中 的 点 P( 或 
器 量 了 ) 的 坐标 必须 左 乘 旋转 窍 阵 。 
这 个 旋转 矩阵 只 适用 于 绕 参 考 坐 标 。 
系 的 x 轴 做 纯 旋 转变 换 的 情况 ， 它 
可 表示 为 
P,. =Rot(x,0)P,,,. (3-15) 
注意 在 式 (3-15 ) 中 ,旋转 矩阵 

















的 第 一 列表 示 相 对 于 * 轴 的 位 置 ， 
其 值 为 1，0，0， 它 表示 沿 x 轴 的 坐 
标 没 有 改变 。 
为 简化 书写 ， 习 惯用 符号 C9 表 图 3-9 ”相对 于 参考 坐标 系 的 点 的 
示 cosb 以 及 用 S9 表示 sing。 因 此 ， 坐标 和 从 x 轴 上 观察 旋转 坐标 系 
旋转 矩阵 也 可 写 为 
1 0 0 
Rot(x,0)=|0 C0 -Sb (3-16) 
0 SO C0 


可 用 同样 的 方法 来 分 析 坐 标 系 绕 参 考 坐标 系 y 轴 和 z 轴 旋 转 的 情况 ， 可 以 证 明 其 结 采 
为 
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CO 0 Sb CO -Sb 0 
0 1 0 en | CO 0 
-SO 0 C0 0 0 1 

式 (3-15 ) 也 可 写 为 习惯 的 形式 ， 以 便于 理解 不 同 坐 标 系 间 的 关系 ， 为 此 ， 可 将 该 变换 表 
示 为 "Tx[ 读 作 坐 标 系 R 相对 于 坐标 系 U( Universe) 的 变换 ] ， 将 P,,, 表 示 为 "P(P 相对 于 坐标 
系 尺 ) ,将 P,. 表 示 为 "P(P 相对 于 坐标 系 0) ， 式 (3-15 ) 可 简化 为 

WN (3-18) 

由 上 式 可 见 ， 去 挥 RR 便 得 到 了 P 相对 于 坐标 系 上 U 的 坐标 。 

(三 ) 复合 变换 的 表示 

复合 变换 是 由 固定 参考 坐标 系 或 当前 运动 坐标 系 的 一 系列 沿 轴 平 移 和 绕 轴 旋转 变换 所 组 
成 的 。 任 何 变换 都 可 以 分 解 为 按 一 定 顺序 的 一 组 平移 和 旋转 变换 。 例 如 ， 为 了 完成 所 要 求 的 
变换 ， 可 以 先 绕 x 轴 旋 转 ， 青 沿 x，y，z 轴 平 移 ， 最 后 绕 y 轴 旋 转 。 在 后 面 将 会 看 到 ， 这 个 
变换 顺序 很 重要 ， 如 果 颠 倒 两 个 依次 变换 的 顺序 ， 结 果 将 会 完全 不 同 。 

为 了 探讨 如 何 处 理 复 合 变 换 ， 假 定 坐 标 系 (n，o，a) 相对 于 参考 坐标 系 (x*，y，z) 依次 
进行 了 下 面 三 个 变换 : 

1 ) 绕 x 轴 旋 转 a 度 。 

2 ) 接 着 平移 (Li ，1,，/s) (分 别 相 对 于 x，y, z 轴 )。 

3 ) 最 后 绕 y 轴 旋 转 B 度 。 

比如 点 Pj 固定 在 旋转 坐标 系 ， 开 始 时 旋转 坐标 系 的 原点 与 参考 坐标 系 的 原点 重合 。B 
者 坐标 系 (n，o，a) 相对 于 参考 坐标 系 旋转 或 者 平移 时 ， 坐 标 系 中 的 尸 点 相对 于 参考 坐标 系 
也 跟着 改变 。 如 前 面 所 看 到 的 ， 第 一 次 变换 后 ，P 点 相对 于 参考 坐标 系 的 坐标 可 用 下 列 方程 
进行 计算 


Rot(y,0) = C1 

















P, ,= Rot(x,a)P,,, (3-19) 
其 中 ，P .是 第 一 次 变换 后 该 点 相对 于 参考 坐标 系 的 坐标 。 第 二 次 变换 后 ， 该 点 相对 于 
参考 坐标 系 的 坐标 是 
P, ,= Trans(li,b, ,ls)P, ,= Trans(li,b, ,ls)Rot(x,a)P,,, 
同样 ， 第 三 次 变换 后 ， 该 点 相对 于 参考 坐标 系 的 坐标 为 
P,, =P, ,, = Rot(y,B)P, = Rot(y,B) Trans(l,L, ,Ls) Rot(x,a)P,,, 
可 见 ， 每 次 变换 后 该 点 相对 于 参考 坐标 系 的 坐标 都 是 通过 用 每 个 变换 矩阵 左 乘 该 点 的 坐 
标 得 到 的 。 当 然 ， 和 矩阵 的 顺序 不 能 改变 。 同 时 还 应 注意 ， 对 于 相对 于 参考 坐标 系 的 每 次 变 
换 ， 和 矩阵 都 是 左 乘 的 。 因 此 ， 和 拢 阵 书 写 的 顺序 和 进行 变换 的 顺序 正好 相反 。 
(四 ) 变换 矩阵 的 逆 
正如 前 面 所 提 到 的 ， 在 机 顺 人 分 析 过 程 中 有 很 多 地 方 要 用 到 和 矩阵 的 逆 ， 在 下 面 的 例子 中 
可 以 看 到 一 种 涉及 变换 矩阵 的 情况 。 在 图 3-10 中 ， 假 设 机 舌 人 要 在 零件 已 上 钻 孔 而 须 向 零 
件 己 处 移动 。 机 器 人 基 座 相对 于 参考 坐标 系 0 的 位 置 用 坐标 系 妈 来 描述 ， 机 器 人 手 用 坐标 
系 马 来 描述 ,末端 执 行 锅 ( 即 用 来 钻 孔 的 销 头 的 末端 ) 用 坐标 系 达 来 描述 ， 和 零件 的 位 置 用 坐 
标 系 书 来 描述 。 钻 孔 的 点 的 位 置 与 参考 坐标 系 U0 可 以 通过 两 个 独立 的 路 径 发 生 联 系 : 一 个 
是 通过 该 雯 件 的 路 径 ， 另 一 个 是 通过 机 器 人 的 路 径 。 因 此 ， 可 以 写 出 下 面 的 方程 : 
人 (3-20 ) 
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这 就 是 说 ， 该 零件 中 点 的 位 置 可 以 通过 从 UV 变换 到 了， 并 从 P 变换 到 来 完成 ,或 者 从 
U 变换 到 RR， 从 RR 变换 到 有 ,再 从 及 变换 到 久 。 





图 3-10 ”全 局 坐标 系 、 机 船 人 坐标 系 、 手 坐标 系 、 
零件 坐标 系 及 末端 执行 器 坐 标 系 








事实 上 ， 由 于 在 任何 情况 下 机 器 人 的 基 座 位 置 在 安装 时 就 是 已 知 的 ， 因 此 变换 7 ( 坐 
标 系 相对 于 坐标 系 U0 的 变换 ) 是 已 知 的 。 比 如 ， 一 个 机 需 人 安装 在 一 个 工作 合 上 ， 由 于 它 
被 紧 固 在 工作 台 上 ， 所 以 它 的 基 座 的 位 置 是 已 知 的。 即使 机 各 人 是 可 移 的 或 放 在 传送 市 上 ， 
因为 控制 带 始 终 掌 控 着 机 如 人 基 座 的 运动 ， 因 此 它 在 任意 时 刻 的 位 置 也 是 已 知 的 。 由 于 用 于 
末端 执行 器 的 任何 器 械 都 是 已 知 的 ， 而 且 其 尺寸 和 结构 也 是 已 知 的 ， 所 以 "Ts( 机 器 人 末端 
执行 器 相对 于 机 器 人 手 的 变换 ) 也 是 已 知 的 。 此 外 ，"T; (零件 相对 于 全 局 坐标 系 的 变换 ) 也 
是 已 知 的 ， 还 必须 要 知道 将 在 其 上 面 钻 孔 的 零件 的 位 置 ， 该 位 置 可 以 通过 将 该 零件 放 在 钻 模 
上 ， 然 后 用 照相 机 、 视 觉 系 统 、 传 送 融 、 传 感 硕 或 其 他 类 似 仪 融 来 确定 。 最 后 再 要 知道 零件 
上 销 孔 的 位 置 ， 所 以 “Ts 也 是 已 知 的 。 此 时 ,唯一 未 知 的 变换 就 是 "Tj( 机 器 人 手相 对 于 机 融 
人 基 座 的 变换 ) 。 因 此 ， 必 须 找 出 机 需 人 的 关节 变量 (机 希 人 旋转 关节 的 角度 以 及 滑动 关节 
的 连 杆 长 度 ) ， 以 便 将 末端 执行 辟 定 位 在 要 外 孔 的 位 置 上 。 可 见 ， 必 须要 计算 出 这 个 变换 ， 
它 指出 机 需 人 需要 完成 的 工作 。 后 面 将 用 所 求 出 的 变换 来 求解 机 符 人 关节 的 角度 和 连 杆 的 长 
度 。 
不 能 像 在 代数 方程 中 那样 来 计算 这 个 矩阵 ， 即 不 能 简单 地 用 方程 的 右边 除 以 方程 的 左 
边 ， 而 应 该 用 合适 的 矩阵 的 逆 并 通过 左 乘 或 右 乘 来 将 它们 从 左边 去 掉 。 因 此 有 
(TD (TITr Te)( Te) = Te) (Tp TE) TT) (3-21) 
由 于 ( Th) (Ta) =1 和 (“Ts)(“Ts)”=1, 式 (3-21) 的 左边 可 简化 为 *Ts， 于 是 得 
Tt TE TT (3-22) 
该 方程 的 正确 性 可 以 通过 认为 “7y 与 (7T;) ' 相 同 来 加 以 检验 。 因 此 ， 该 方程 可 重 写 为 
TT, CT Ty TCT) Sy TT, Ty = (3°23) 
显然 ,为 了 对 机 磊 人 运动 学 进行 分 析 ， 需 要 能 够 计算 变换 矩阵 的 逆 。 
来 看 看 关于 x 轴 的 简单 旋转 矩阵 的 求 逆 计 算 和 情况 。 关 于 x 轴 的 旋转 矩阵 是 
1 0 0 
Rot(x,0) -| CO -SO0 
0 50 C0 


























(3-24) 
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必须 采用 以 下 的 步骤 来 计算 和 矩阵 的 逆 : 
1) 计算 和 矩阵 的 行列 式 。 
2) 将 矩阵 转 置 。 
3) 将 转 置 矩阵 的 每 个 元 素 用 它 的 子 行列 式 ( 伴 随和 矩阵 ) 代 替 。 
4) 用 转换 后 的 矩阵 除 以 行列 式 。 
将 上 面 的 步骤 用 到 该 旋转 ， 得 到 
4=1(C20+S0) +0=1 


1 0 0 
Rot (x, ok C0 | 


0 -S50 CO 
现在 计算 每 一 个 子 行列 式 (伴随 矩阵 ) 。 例 如 : 元 素 2，2 的 子 行列 式 是 C9 -0= C0; 元 
素 1，1 的 子 行列 式 CO+S0=1。 可 以 注意 到 ， 这 里 的 每 一 个 元 素 的 子 行 列 式 与 其 本 身 相 
同 ， 因 此 有 











Rot (x，0)， =Rot (x，0)” 
由 于 原 旋 转 和 矩阵 的 行列 式 为 1， 因 此 用 Rot (*，0) ww 矩阵 除 以 行列 式 仍 得 出 相同 的 结 
果 。 因 此 ， 关 于 x 轴 的 旋转 和 矩阵 的 逆 的 行列 式 与 它 的 转 置 矩 阵 相 同 ， 即 
Rot (x,0) -=Rot(x,0)7 (3-25) 





具有 这 种 特征 的 矩阵 称 为 西 和 矩阵， 也 束 是 说 所 有 的 旋转 矩阵 都 是 西 和 矩阵。 因此， 计算 旋 
转 矩 阵 的 逆 束 是 将 该 矩阵 转 置 。 可 以 证 明 ， 关 于 y 轴 和 zz 轴 的 旋转 矩阵 同样 也 是 西 和 矩阵 。 

应 注意 ， 只 有 旋转 矩阵 才 是 西 算 阵 。 如 采 一 个 矩阵 不 是 一 个 简单 的 旋转 矩阵 ， 那 么 它 也 
许 就 不 是 西 和 矩阵 。 

以 上 结论 只 对 简单 的 不 表示 位 置 的 3 x3 旋转 矩阵 成 立 。 对 一 个 齐 次 的 4x4 变换 矩阵 而 
言 ， 它 的 求 逆 可 以 将 矩阵 分 为 两 部 分 。 和 矩阵 的 旋转 部 分 仍 是 西 算 阵 ， 只 需 简 单 的 转 置 ; 矩阵 
的 位 置 部 分 是 向 量 了 分 别 与 4,，0o，a 向 量 点 积 的 负 值 ， 其 结果 为 








(3-26) 


0 0 0 1 
n, n, n, -PP:n 
0o, 0, 0 -PP':o 
5 a. a, a, -Pr:a 


0 0 0 1 
如 上 所 示 ， 和 矩阵 的 旋转 部 分 是 简单 的 转 置 ， 转 置 的 部 分 由 点 乘 的 负 值 代 替 ， 而 最 后 一 行 
(比例 因子 ) 则 不 受 影 响 。 这 样 做 对 于 计算 变换 矩阵 的 逆 是 很 有 帮助 的 ， 而 直接 计算 4 x4 算 
阵 的 逆 是 一 个 很 元 长 的 过 程 。 
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第 一 了 “工业 机 等 人 运动 学 方程 


六 -六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 信人 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 人 六 尖 盖 人 六 人 六 
NAA 人 A 和 NA; 人 人 全 


假设 有 一 个 构 型 已 知 的 机 融 人 ， 即 它 的 所 有 连 杆 长 度 和 着 角度 都 是 已 知 的 ， 那 么 计算 
机 带 人 手 的 位 姿 就 称 为 正 运 动 学 人 分析。 换言之， 如 果 已 知 所 有 机 大人 关 市 变量 ， 用 正 运动 学 
方程 束 能 计算 任 一 瞬间 机 融 人 的 位 姿 。 然 而 ， 如 末 想 要 将 机 人 右 人 的 手 放 在 一 个 期 望 的 位 姿 ， 
就 必须 知道 机 融 人 每 一 个 连 杆 的 长 度 和 关节 的 角度 ， 只 有 这 样 才 能 将 手 定位 在 所 期 望 的 位 
姿 ， 这 称 为 逆 运 动 学 分 析 ， 也 就 是 说 ,这 里 不 是 把 已 知 的 机 右 人 变量 代入 正 向 运动 学 方程 
中 ， 而 是 要 设法 找到 这 些 方程 的 逆 ， 从 而 求 得 所 需 的 关节 变量 ， 使 机 船 人 放置 在 期 望 的 位 
姿 。 事 实 上 ， 逆 运动 学 方程 更 为 重要 ， 机 需 人 的 控制 锅 将 用 这 些 方程 来 计算 关节 值 ， 并 以 此 
来 运行 机 釉 人 到 达 期 望 的 位 姿 。 下 面 首 移 推 导 机 豆 人 的 正 运动 学 方程 ， 然 后 利用 这 些 方程 来 
计算 逆 运 动 学 方程 。 

对 正 运动 学 ， 必 须 推 导出 一 组 与 机 货 人 特定 构 型 (将 构件 组 合 在 一 起 构成 机 做 人 的 方 
法 ) 有 关 的 方程 ， 以 使 得 将 有 关 的 关节 和 连 杆 变量 代入 这 些 方程 就 能 计算 出 机 规 人 的 位 姿 ， 
然后 可 用 这 些 方程 推出 逆 运 动 学 方程 。 

要 确定 一 个 刚体 在 空间 的 位 姿 ， 须 在 物体 上 固 连 一 个 坐标 系 ， 然 后 描述 该 坐标 系 的 原点 
位 置 和 它 三 个 轴 的 姿态 ， 总 共 需 要 六 个 自由 度 或 六 条 信息 来 完整 地 定义 该 物体 的 位 姿 。 同 




















理 ， 如 琳 要 确定 或 找到 机 帮 人 手 在 空间 的 位 姿 ， 也 
必须 在 机 带 人 手 上 固 连 一 个 坐标 系 并 确定 机 大 人 手 \ 
坐标 系 的 位 姿 ， 这 正 是 机 器 人 正 运动 学 方程 所 要 完 “I 5 


成 的 任务 。 换 言 之 ,根据 机 右 人 连 杆 和 关节 的 构 型 
配置 ， 可 用 一 组 特定 的 方程 来 建立 机 侣 人 手 的 坐标 
系 和 参考 坐标 系 之 间 的 联系 。 图 3-11 所 示 为 机 各 人 
手 的 坐标 系 、 参 考 坐 标 系 以 及 它们 的 相对 位 姿 ， 两 
个 坐标 系 之 间 的 关系 与 机 项 人 的 构 型 有 关 。 当 然 ， 
机 各 人 可 能 有 许多 不 同 的 构 型 后面 将 会 看 到 将 如 
何 根 据 机 右 人 的 构 型 来 推导 出 与 这 两 个 坐标 系 相关 
的 方程 。 

为 使 过 程 简 化 ， 可 分 别 分 析 位 置 和 姿态 问题 ， 
首先 推导 出 位 置 方程 ， 然 后 再 推导 出 姿态 方程 ， 再 
将 两 者 结合 在 一 起 形成 一 组 完整 的 方程 。 最 后 ， 将 
看 到 关于 Denavit-Hartenberg 表示 法 的 应 用 ， 该 方法 可 用 于 对 任何 机 各 人 构 型 建 模 。 














xX 


图 3-11 机 器 人 手 的 坐标 系 
相对 于 参考 坐标 系 








一 、 位 置 的 正 逆 运动 学 方程 


对 于 机 人 帮 人 的 定位 ， 可 以 通过 相对 于 任何 惯用 坐标 系 的 运动 来 实现 。 比 如 ， 基 于 直角 从 
标 系 对 空间 的 一 个 点 定位 ， 这 意味 着 有 三 个 关于 *，y，z 轴 的 线性 运动 ， 此 外 ， 如 采用 球 坐 
标 来 实现 ， 就 意味 着 需要 有 一 个 线性 运动 和 两 个 旋转 运动 。 和 常见 的 情况 有 : (D 笛 卡 儿 ( 台 
架 ， 直 角 ) 坐标 ; @ 圆 柱 坐 标 ; (3) 球 坐标 ;， (9 链 式 (拟人 或 全 旋转 ) 坐标 。 
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(一 ) 笛 卡 儿 ( 人 台 染 ， 直 角 ) 坐标 

这 种 情况 下 有 三 个 沿 x*,，y,z 轴 的 线性 运动 ， 这 一 类 型 机 融 人 所 有 的 驱动 机 构 都 是 线性 
的 (比如 液压 活 禾 或 线性 动力 丝 杠 )， 这 时 机 大 人 手 的 定 
位 是 通过 三 个 线性 关 市 分 别 沿 三 个 轴 的 运动 来 完成 的 (图 
3-12)。 台 架 式 机 右 人 基本 上 就 是 一 个 直角 坐标 机 带 人 ， 
只 不 过 是 将 机 带 人 固 连 在 一 个 朝 下 的 直角 加 上 。 

当然 ,如 果 没 有 旋转 运动 ,表示 癌 已 点 运动 的 变换 矩 
阵 是 一 种 简单 的 平移 变换 矩阵 ,下 面 将 可 以 看 到 这 一 点 。 
注意 这 里 只 涉及 坐标 系 原 点 的 定位 ,而 不 涉及 姿态 。 在 直 
角 坐 标 系 中 ,表示 机 天 人 手 位 置 的 正 运动 学 变换 矩阵 为 











1 0 0 P 
人 (3-27 ) 
”oo1P 
0 00 1 图 3-12 直角 坐标 





其 中 7 是 参考 坐标 系 与 手 坐 标 系 原 点 的 变换 算 
阵 ， 而 Ti 表示 直角 坐标 变换 算 阵 。 对 于 逆 运 动 学 的 求解 ， 
只 需 简 单 地 设 定期 望 的 位 置 等 于 P。 

(二 ) 圆柱 坐标 

圆柱 形 坐 标 系统 包括 两 个 线性 平移 运动 和 一 个 旋转 运 
动 。 其 顺序 为 : 先 沿 x 轴 移 动 >， 再 绕 z 轴 旋 转 w 角 ， 最 后 
治 z 轴 移动 /1， 如 图 3-13 所 示 。 这 三 个 变换 建立 了 手 坐 标 
系 与 参考 坐标 系 之 间 的 联系 。 由 于 这 些 变换 都 是 相对 于 全 
局 参考 坐标 系 的 坐标 轴 的 ， 因 此 由 这 三 个 变换 所 产生 的 总 
变换 可 以 通过 依次 左 乘 每 一 个 矩阵 而 求 得 ， 即 

“人 T(r,a,l) =Trans(0,0,l) Rot(z,a) Trans(7r,0,0) 
(3-28) 

OVCa -Sa 0 0 























图 3-13 圆柱 坐标 


1 0 0 1 0 0 r 
. 0 1 0 0llSa Ca 0 0I10 1 0 0 
fe (3-29) 

0 0 1 LI 0 0 1 010 0 1 0 
0 0 0 1 人 0 0 0 1 八 0 0 0 1 

Ca -Sa 0 rCa 

Sa Ca 0 rsSa 

T, = 7 名 ] 二 


0 0 ] 1 
0 0 0 1 
经 过 一 系列 变换 后 ， 前 三 列表 示 了 坐标 系 的 姿态 ， 然 而 我 们 只 对 坐标 系 的 原点 位 置 即 最 
后 一 列 感 兴 趣 。 显 然 ， 在 圆柱 形 坐 标 运 动 中 ， 由 于 绕 z 轴 旋 转 了 a 角 ， 运 动 坐标 系 的 姿态 也 
将 改变 ， 这 一 改变 将 在 后 面 讨论 。 
实际 上 ， 可 以 通过 绕 n，o，a 坐标 系 中 的 a 轴 旋 转 -a 角度， 使 坐标 系 回转 到 和 初始 参 
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考 坐 标 系 平行 的 状态 ， 它 等 效 于 圆柱 坐标 矩 阵 右 乘 旋转 矩阵 ([w，- a) ， 其 结 打 是 ， 该 坐标 
系 的 位 置 仍 在 同一 地 方 ， 但 其 姿态 再 次 平行 于 参考 坐标 系 ， 如 下 所 示 : 








Ca -Sa 0 rCaVC(-a) -SS(-a) 0 0 1 0 0 rCa 

Sa Ca 0 rSalS(-a) C(-a) 0 0 0 1 0 ma 
TRot(z, —Q) 二 三 

0 0 1 [ 0 0 1 0 0 0 1 1 

0 0 0 1 0 0 0 1 0 0 0 1 





由 此 可 见 ， 运动 坐标 系 的 原点 位 置 没 有 改变 ， 
但 它 转 回 到 了 与 参考 坐标 系 平行 的 状态 。 需 注意 的 
是 ， 最 后 的 旋转 是 绕 本 地 坐标 系 的 a 轴 的 ， 甚 目的 
是 不 引起 坐标 系 位 置 的 任何 改变 ， 而 只 改变 姿态 。 

(三 ) 球 坐标 

如 图 3-14 所 示 ， 球 坐标 系统 由 一 个 线性 运动 和 
两 个 旋转 运动 组 成 ， 运 动 顺 序 为 : 先 沿 z 轴 平 移 ~， 
再 绕 y 轴 旋 转 B 并 绕 z 轴 旋 转 y。 这 三 个 变换 建立 了 
手 坐 标 系 与 参考 坐标 系 之 间 的 联系 。 由 于 这 些 变换 




















都 是 相对 于 全 局 参考 坐标 系 的 坐标 轴 的 ， 因 此 由 这 、 
三 个 变换 所 产生 的 总 变换 可 以 通过 依次 左 乘 每 一 个 ee 
得 图 3-14” 球 坐标 
和 矩阵 而 求 得 
六 =T,,(r,B,Y) = Rot(z,y) Rot(y,B)Trans(0,0,7) (3-30) 
Cy -Sy 0 0YC 0 3S8 OY1 0 0 0 
ee Sy Cy 0 0 0 1 0 010 1 0 0 
”|0 0 10| -sp 0 Cc olo 0 1 
0 0 0 1 0 0 0 1 八 0 0 0 1 
CB'Cy -Sy SB:Cy rrB:Cy 
CB':S C SB:S SB:S 
Ap, =T,, = BY 7 SSB:Sy 77398737 (3.31) 
-SB 0 CB rCB 
0 0 0 1 


前 三 列表 示 了 经 过 一 系列 变换 后 的 坐标 系 的 次 
态 ， 而 最 后 一 列 则 表示 了 坐标 系 原点 的 位 置 。 以 后 还 
要 进一步 讨论 该 矩阵 的 姿态 部 分 。 

这 里 也 可 回转 最 后 一 个 坐标 系 ， 使 它 与 参考 坐标 
系 平行 。 这 一 问题 将 作为 练习 留 给 读者 ， 要 求 找 出 正 
确 的 运动 顺序 来 获得 正确 的 答案 。 

球 坐 标的 道 运动 学 方程 比 简单 的 直角 坐标 和 圆柱 
坐标 更 复杂 ， 因 为 两 个 角度 B 和 y 是 耦合 的 。 下 面 通 
过 例子 来 说 明 如 何 求解 球 坐 标的 逆 运 动 学 方程 。 

(四 ) 链 式 坐标 

如 图 3-15 所 示 ， 链 式 坐 标 由 3 个 旋转 组 成 。 后 而 
在 讨论 Denavit-Hartenberg 表示 法 时 ， 将 推导 链 式 坐标 














图 3-15 ” 链 式 坐标 
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二 、 姿 态 的 正 逆 运动 学 方程 





假设 固 连 在 机 右 人 手 上 的 运动 坐标 系 已 经 运动 到 期 望 的 位 置 上 ,但 它 仍 然 平 行 于 参考 坐 
标 系 ， 或 者 假设 其 姿态 并 不 是 所 期 望 的 ， 下 一 步 是 要 在 不 改变 位 置 的 情况 下 ， 适 当地 旋转 坐 
标 系 而 使 其 达到 所 期 望 的 姿态 。 合 适 的 旋转 顺序 取决 于 机 需 人 手 腊 的 设计 以 及 关节 装配 在 一 
起 的 方式 。 考 虑 以 下 三 种 常见 的 构 型 配置 : 

1) 滚动 角 、 仍 仰角 、 偶 航 角 (RPY )。 

2) 欧 拉 角 。 

3) 链 式 关 市 。 

(一 ) 滚动 角 、 俯 仰角 和 偏 航 角 

这 是 分 别 绕 当前 w&，o, 二 轴 的 三 个 旋转 顺序 ， 能 够 把 机 豆 人 的 手 调 整 到 所 期 望 的 姿态 。 
此 时 ,假定 当前 的 坐标 系 平行 于 参考 坐标 系 ， 于 是 机 侣 人 手 的 姿态 在 RPY( 滚 动 角 、 俯 仰 
角 、 偏 豚 角 ) 运 动 前 与 参考 坐标 系 相 同 。 如 采 当 前 坐标 系 不 平行 于 参考 坐标 系 ， 那 么 机 各 人 
手 最 终 的 姿态 将 会 是 先前 的 姿态 与 RPY 右 乘 的 结 

因为 不 希望 运动 坐标 系 原 点 的 位 置 有 任何 改变 ( 它 已 被 放 在 一 个 期 望 的 位 置 上 ， 所 以 只 
需要 旋转 它 到 所 期 望 的 姿态 ) ， 所 以 RPY 的 旋转 运动 都 是 相对 于 当前 的 运动 轴 的 。 和 否则， 如 
前 面 所 看 到 的 ， 运 动 坐标 系 的 位 置 将 会 改变 。 于 是 ， 右 乘 所 有 由 RPY 和 其 他 旋转 所 产生 的 
与 姿态 改变 有 关 的 矩阵 。 

参考 图 3-16， 可 看 到 RPY 旋转 包括 以 下 几 种 : 
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图 3-16 绕 当前 坐标 轴 的 RPY 旋转 
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1) 绕 a 轴 ( 运 动 坐标 系 的 z 轴 ) 旋 转 pp, 称 为 滚动 。 
2) 绕 o 轴 ( 运 动 坐标 系 的 y 轴 ) 旋转 9p, 称 为 俯仰 。 
3) 绕 nn 轴 (运动 坐标 系 的 x 轴 ) 旋转 wp, 称 为 偏 航 。 
表示 RPY 姿态 变化 的 矩阵 为 
RPY(g,, 9,, 9,) = Rot(a, 9,)Rot(o, 9,)Rot(n, 9,) = 
CoCp, Co Sp Sp -SPCp, CoaSp Cp +Spa Sp, 0 
SpaCp, 59puo5puop tCpCp, 5puopoCp -Co ip, 0 (3.32) 
一 59p。 CPp5p， CPp,CP， 0 
0 0 0 1 
这 个 矩阵 表示 了 仅 由 RPY 引起 的 姿态 变化 。 该 坐标 系 相 对 于 参考 坐标 系 的 位 置 和 最 终 
姿态 是 表示 位 置 变 化 和 RPY 的 两 个 矩阵 的 乘积 。 例 如 ， 假设 一 个 机 器 人 是 根据 球 坐 标 和 
RPY 来 设计 的 ， 那 么 这 个 机 需 人 就 可 以 表示 为 
=Tw(r，B，7y)RPY(p，9p,，pn) 
关于 RPY 的 逆 运 动 学 方程 的 解 比 球 坐 标 更 复杂 ， 因 为 这 里 有 三 个 耦合 角 ， ， 
有 三 个 角 各 自 的 正弦 值 和 余弦 值 的 信息 才能 解 出 这 个 角 。 为 解 出 这 三 个 角 的 正弦 值 和 余 
值 ， 必 须 将 这 些 角 解 厢 。 因 此 ， 用 Rot(wc，?。) 的 逆 左 乘 方程 两 边 ， 得 
Rot (a,p,) RPY(9,,9,,9,) =Rot(o,9,)Rot(n,g,) (3-33) 
假设 用 RPY 得 到 的 最 后 所 期 望 的 姿态 是 用 (n，o，a) 和 矩阵 来 表示 的 ， 则 有 


n, o,. a, 0 


a Sy 
Rot (ap，) = Rot(o,9,) Rot(n,o,) (3-34) 
Nn 


Q 
OO OO 


进行 矩阵 相 乘 后 得 
mCopa tn Sp osCpo+oop ap +aop。 0 

mn Cp -np op 一 op。 wp 一 aop。 0 

0 

1 











Nn, 0, Q; 
0 
下 SPpuCPp， 0 
E Be 的 
-5p。 Cop, CoCp, 0 
0 0 1 
在 式 (3-34) 中 的 n，o， 4a 分量 Re 它们 通常 是 给 定 或 已 知 的 ， 而 RPY 


角 的 值 是 未 知 的 变量 。 
让 式 (3-35 ) 左 右 两 边 对 应 的 元 素 相 等 ,将 产生 如 下 结 
根据 2，1 元 素 得 
nCops -nSps =0 一 p。 =ATAN2(n,n) ps =ATAN2( -nn,, —n,) (3-36) 
根据 3，1 元 素 和 1，1 元 素 得 
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S9, = —n, 


(3-37) 
Cop,=n.Cp, tn,Sp. 9p, = ATAN2| -m (PCep +n,Sop,)] 
根据 2，2 元 素 和 2，3 元 素 得 
CP， 二 0 CO， 一 0.9S0D， 
(3-38) 


Sp = -a,Cpa taSp 9p, = ATAN2| ( ~a,Cp, + a.Sp,), (0,C9p, 一 osSpo) 
(二 ) 欧 拉 角 
除了 最 后 的 旋转 是 沿 当 前 的 a 轴 外 ， 欧 拉 角 的 其 他 方面 均 与 RPY 相似 (参见 图 3-17 ) 。 
我 们 仍 需要 使 所 有 旋转 都 是 绕 当 前 的 轴 转 劲 ， 以 防止 机 器 人 的 位 置 有 任何 改变 。 表 示 欧 拉 角 
1) 绕 5 轴 (运动 坐标 系 的 z 轴 ) 旋 转 wp 度 。 
2) 接着 绕 o 轴 ( 运 动 坐标 系 的 y 轴 ) 旋 转 0 度 。 
3) 最 后 再 绕 a 轴 ( 运 动 坐标 系 的 x 轴 ) 旋 转 y 度 。 
表示 欧 拉 角 姿态 变化 的 矩阵 是 
Euler(@,0,%) = Rot(a,wp)Rot(o,0)Rot(a,y) = 
CoCOCy -SpoCYy -CopCOW -SpoCy CopS0 0 
SoCOCy +CoSy -SpoCOSy +CPpCw SoS0 0 
— SOCy SOSV CoO 0 








(3-39 ) 








图 3-17 绕 当前 坐标 轴 的 欧 拉 旋转 


再 次 强调 ， 该 矩阵 只 是 表示 了 由 欧 拉 角 所 引起 的 姿态 变化 。 相 对 于 参考 坐标 系 ， 这 个 坐 
标 系 的 最 终 位 姿 是 表示 位 置 变 化 的 矩阵 和 表示 欧 拉 角 的 矩阵 的 乘积 。 

欧 拉 角 的 逆 运 动 学 求解 与 RPY 非常 相似 。 可 以 使 欧 拉 方程 的 两 边 左 乘 Rot (a，gq ) 来 
消去 其 中 一 边 的 。 让 两 边 的 对 应 元 系 相 等 ， 就 可 得 到 以 下 方程 [ 假设 由 欧 拉 角 得 到 的 最 终 
所 期 望 的 姿态 是 由 (n，o，a) 和 矩阵 表示 ]， 即 
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n, 0 Qa 0 CoCy -CoSw SS 0 
ol Way n, 0o, a, 0 Su Cy 0 0 (3.40) 
n,. o0o, a, 0 -SOCy SOS Co 0 
0 0 0 1 0 0 0 1 
或 
mC Cop+tnSp oCptoSp aCptoSp 0 CoCy -CoSsy S6 0 
-nSp+t+nCp -oop+ocp -adSptaCp 0 Sy Cy 0 0 
n, 0, a, 0 -SO0C% SOS Co 0 
0 0 0 1 0 0 J 
(3-41) 





记 住 ,， 式 (3-40) 中 的 n,，o, a 表示 了 最 终 的 期 望 值 ， 它 们 通常 是 给 定 或 已 知 的 。 欧 拉 
角 的 值 是 未 知 变 量 。 
让 式 (3-41) 左 右 两 边 对 应 的 元 素 相 等 ， 可 得 到 如 下 结 末 : 
根据 2，3 元 素 ， 可 得 
-aSp +aCp=0—>9p =ATAN2(a,,a,) 或 p=ATAN2( -a,, -a,) (3-42) 
由 于 求 得 了 值 ， 因 此 式 (3-41 ) 左 边 所 有 的 元 素 都 是 已 知 的 。 根 据 2，1 元 素 和 2，2 元 素 








一 
dd 


= -np+t+n,Cop 
Cy = -osSp +oCp 一 过 =ATAN2( -nSop +n,Co, -oS9p +o,C9) (3-43 ) 
最 后 根据 1，3 元 素 和 3，3 元 素 ， 得 
S50=a.Cp +a,S9p (3.44) 
CO=a.—0=ATAN2(a,Cop +a,Sgp,a.) 

(三 ) 链 式 关节 

链 式 关 市 由 3 个 旋转 组 成 ， 而 不 是 上 面 刚 提出 来 的 旋转 模型 ， 这 些 旋转 取决 于 关节 的 设 
计 ， 就 像 在 链 式 坐 标 所 做 的 那样 。 

在 机 需 人 的 基 座 上 ， 可 以 从 第 一 个 关节 开始 变换 到 第 二 个 关节 ， 然 后 到 第 三 个 …… 再 到 
机 硕 人 的 手 ， 最 终 到 末端 执行 希 。 奋 把 每 个 变换 定 为 关节 ， 则 可 以 得 到 许多 表示 变换 的 拢 
阵 。 在 机 如 人 的 基 座 与 手 之 间 的 总 变换 则 为 

“Ty=°" TT, TT, =AA,A;…A, (3-45) 

其 中 半 是 关节 数 。 对 于 一 个 具有 6 个 自由 度 的 机 各 人 而 言 ， 有 6 个 4 矩阵 。 

为 了 简化 4 和 抢 阵 的 计算 ， 可 以 制作 一 张 关 节 和 连 杆 参 数 的 表格 ， 其 中 每 个 连 杆 和 关节 
的 参数 值 可 从 机 器 人 的 原理 示意 图 上 确定 ， 并 且 可 将 这 些 参数 代入 4 矩阵 。 


第 三 节 雅 可 比方 程 与 蘑 力 计算 


六 六 六 -六 -六 -六 六 六 六 六 六 六 六 六 全 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 从 六 六 人 六 
A 人 人 人 A 人 人 作 人 全 

















工业 机 天 人 在 作业 过 程 中 ， 当 手 部 (或 末端 操作 天 ) 与 环境 接触 时 ， 会 引起 各 个 关节 产 
生 相 应 的 作用 力 。 工 业 机 项 人 各 关 布 的 驱动 装置 提供 关节 力矩 ， 通 过 连 杆 传递 到 手 部 ， 殉 服 
外 界 作 用 力 。 本 市 讨论 操作 辟 在 静止 状态 下 力 的 平衡 关系 。 假 定 各 关 市 “ 锁 住 "， 工 业 机 楷 
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人 成 为 一 个 结构 体 。 关 市 的 “锁定 用 ” 力 与 手 部 所 支持 的 载 集 或 受到 外 界 环境 作用 的 力 取得 
静 力 学 平衡 。 求 解 这 种 ”锁定 用 ”的 关节 力矩 ， 或 求解 在 已 知 驱 动力 作用 下 手 部 的 输出 力 就 
是 对 工业 机 甫 人 操作 臂 进行 静 力 学 分 析 。 


一 、 工 业 机 器 人 速度 雅 可 比 


数学 上 雅 可 比 和 给 阵 (Jacobian Matrix ) 是 一 个 多 元 也 数 的 偏 导 和 矩阵。 
假设 有 6 个 孔 数 ， 每 个 函数 有 6 个 变量 ， 即 
yi 3 【六 2 3 ， V4 ,Xs | 


)2 = 2 ,V3 4 ,Xs ;ee 


(3-46) 
6 = 上 大 (1 ,NX> ,NX3 ,NX4 ,Ns i 
可 写成 
Y=F(X) 
将 其 微分 ， 得 
of of of 
yi se + —dx, 十 ee 
XI OX, Ne 
of of oj 
> Se Fe 十 …: Pe 
OX OX, OX6 (3-47) 
of of of 
gy — dx, 十 = +… 十 i 
X1 OX2 Ne 
也 可 简写 成 
oF 
dY = 一 -dX (3-48 ) 
0X 


式 (3.48) 中 的 (6 x6) 知 阵 语 叫 作 准 可 比 箱 阵 。 


在 工业 机 器 人 速度 分 析 和 以 后 的 静 力 学 分 析 中 
都 将 遇 到 类 似 的 矩阵 ， 称 为 工业 机 器 人 雅 可 比 矩 阵 ， 
或 简称 雅 可 比 ， 一 般 用 符号 了 表示 。 
图 3-18 所 示 为 二 自由 上 度 平 面 关节 型 工业 机 各 人 
(2R 工业 机 侣 人 ) ， 其 端点 位 置 *，y 与 关节 变量 0、 
9, 的 关系 为 
[ =/licosO, +l,cos(0, +0,) 











. | (3-49) _ 
y=lsing, +L,sin( 0, +0,) 图 3-18 二 自由 度 平面 


即 关节 型 工业 机 器 人 
| A 01,0, ) 


3-50 
y=7y(0,0,) \ ) 
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将 其 微分 ,得 


将 其 写成 矩阵 形式 为 
本 (3-51 ) 
dy | 用 有 d0， 


J = (352) 


必 


式 (3-51) 可 人 简写 为 
dX =Jd0 (3-53) 


d 
其 中 ax=| d0 = 
dy 





d0， 
网 

将 了 称 为 图 3-18 所 示 二 自由 度 平 面 关 节 型 工业 机 器 人 的 速度 雅 可 比 ， 它 反映 了 关节 空 
间 微 小 运动 4 与 手 部 作业 空间 微小 位 移 dX 之 间 的 关系 。 注 意 : dX 此 时 表示 微小 线 位 移 。 

各 对 式 (3-52 ) 进行 运算 ， 则 2R 工业 机 器 人 的 雅 可 比 写 为 
—lising, ~Lsin(0, +0,) -Ll,sin(0, +0,) 
pa (3-54) 
/cosO +l,cos(0, +0,) l,cos( 0, +0,) 

从 了 中 元 素 的 组 成 可 见 ， 了 和 矩阵 的 值 是 和 及 见 的 函数 。 

对 于 半 个 目 由 度 的 工业 机 器 人 ， 其 关节 变量 可 以 用 广义 着 变量 9 表示，9g = (gq!，g， 
…，g) 。 当 关节 为 转动 关节 时 ，g; = 9 ， 当 关节 为 移动 关节 时 ，9 = 由，d9g = [ dq!，dg;， 
…，dg,) 有 反映 了 关节 空间 的 微小 运动 。 工 业 机 器 人 手 部 在 操作 空间 的 运动 参数 用 表示 ， 
它 是 关 届 变量 的 函数 ， 即 下 = 对 (q) ， 并 且 是 一 个 6 维 列 矢量 ( 因为 表达 空间 刚体 的 运动 需要 
6 个 参数 ， 即 3 个 沿 坐 标 轴 的 独立 移动 和 3 个 绕 坐 标 轴 的 独立 转动 )。 因 此 ,dX = (dx，dy， 
dz，8p, 8p,，8p.) 反映 了 操作 空间 的 微小 运动 ， 它 由 工业 机 器 人 手 部 微小 线 位 移 和 微小 角 
位 移 ( 人 微小 转动 ) 组 成 ,，d 和 $5 没 差 别 ， 因 为 在 数学 上 ，dx = ix。 于 是 ， 参 照 式 (3-53 ) 可 写 出 
类 似 的 方程 式 ， 即 























dX=J(g)dg (3-35) 
式 中 ,，J(gq) 是 6xn 的 偏 导 数 矩 了 泗 ， 称 为 n 自由 度 工业 机 帮 人 速度 雅 可 比 矩 阵 。 它 反映 了 关 
节 空 间 微 小 运动 dg 与 手 部 作业 空间 微小 运动 dX 之 间 的 关系 。 它 的 第 i 行 第 j 列 元 素 为 
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Ox;(q) 





J;(q) = = ,2 0;]=1 ,2 n (3-56) 


二 、 操 作 臂 中 的 静 力 学 


这 里 以 操作 臂 中 单个 杆 件 为 例 分 析 受 力 情况 ， 如 图 3-19 所 示 ， 杆 件 :通过 关节 :和 1+l 
分 别 与 杆 件 i-1 和 杆 件 i+1 相连 接 ， 两 个 坐标 系 生 -1 荆 和 站 分别 如 图 3-19 所 示 。 


关节 i zi hi 2 











图 3-19 杆 i 上 的 力 和 力矩 

















图 3-19 中 
fii 及 Mii 一 一 i -1 杆 通 过 关节 i 作用 在 i 杆 上 的 力 和 力矩 ; 
所 ii 及 Mii 一 一 i 杆 通 过关 市 i+1 作用 在 i+1 杆 上 的 力 和 力矩 ; 
-fiitt 及 -Miiw 一 一 i+1 杆 通 过 关 市 i+1 作用 在 i 杆 上 的 反作用 力 和 反作用 力 甜 ; 
矿 ， 及 Mi 一 一 工业 机 需 人 手 部 端点 对 外 界 环 境 的 作用 力 和 力矩 ; 
-所 及 -1 一 一 外 界 环境 对 工业 机 和 硕 人 手 部 端点 的 作用 力 和 力 托 ; 


所 及 M1 一 工业 机 器 人 底座 对 杆 1 的 作用 力 和 力矩 ; 





m8 一 一 连 杆 i 的 重量 ， 作 用 在 质心 C; 上 。 
连 杆 i 的 静 力 学 平衡 条 件 为 其 上 所 受 的 合力 和 合力 矩 为 零 ， 因 此 力 和 力矩 平 衡 方程 式 为 
fiiit( fis) +mg=0 (337) 
144 1 + 人 一 ji) 十 (Fri Fe) + 6 = =0 (3-58) 


式 中 ,7;_1.; 为 坐标 系 1 引 的 原点 相对 于 坐标 系 1i -11 的 位 置 矢量; mc 为 质心 相对 于 坐标 系 
| 计 的 位 置 矢量 。 

假如 已 知 外 界 环 境 对 工业 机 各 人 最 末 杆 的 作用 力 和 力矩 ， 那么 可 以 由 最 后 一 个 连 杆 问 第 
零 号 连 杆 (机 座 ) 依 次 递 推 ， 从 而 计算 出 每 个 连 杆 上 的 受 力 情况 。 

为 了 便于 表示 工业 机 各 人 手 部 端点 对 外 界 环境 的 作用 力 和 力矩 (人 简称 为 端点 力 F)， 可 





M 
各 关节 驱动 硕 的 驱动 力 或 力矩 可 写成 一 个 冯 维 矢量 的 形式 ， 即 


Pi (3.59) 


n,n+l 
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= (3-60) 











式 中 ,nn 为 天 市 的 个 数 ; 7 为 关节 力矩 (或 天 和 力 ) 天 量 ， 简 称 广 义 关 节 力 算 ， 对 于 转动 关 
节 ，7; 表 未 关 市 驱动 力矩 ; 对 于 移动 关节 ,六 表示 关节 驱动 力 。 


三 、 工 业 机 器 人 静 力 学 分 析 


假定 关 届 无 雄 擦 ， 并 忽略 各 杆 件 的 重力 ， 则 广义 关节 力矩 7 与 工业 机 各 人 手 部 端点 力 F 
的 关系 可 用 下 式 摘 述 ， 即 











7=JF (3-61) 
式 中 ,六 为 nx6 阶 工业 机 器 人 力 雅 可 比 和 矩阵 或 力 雅 可 比 。 
上 和 式 可 用 下 述 虚 功 原理 证 明 : 
证 明 考虑 各 个 关 市 的 虚 位 移 为 5q;, 手 
部 的 虚 位 移 为 5 ， 如 图 3-20 所 示 。 
及 4 =(3q ,30 ,3q) (3-62) 
d 
3 = 加 
式 中 , d= (d,, d,, d.) 和 5= (59,，59,,， 
8p.] 分 别 对 应 于 手 部 的 线 虚 位 移 和 角 虚 位 移 
(作业 空间 ) ;84 为 由 各 关节 虚 位 移 89; 组 成 的 0 TA 
工业 机 器 人 关节 虚 位 移 矢量 (关节 空间 ) 。 
假设 发 生 上 述 虚 位 移 时 ， 各 关 市 力 窍 为 7;(i=1，2,，…,n)， 环境 作用 在 工业 机 器 人 手 
部 端点 上 的 力 和 力矩 分 别 为 - 刻 , 和 -Ms。 由 上 述 力 和 力矩 所 做 的 虚 功 可 以 由 下 式 求 
出 ， 即 






M 


nntl 











SW=75g1 +T250 + … +7,0g, -fnrid ~-M, ,6 
或 写成 
SW=7 5g—F 5X (3-63) 
根据 虚 位 移 原理 ， 工 业 机 妖 人 处 于 平衡 状态 的 充分 必要 条 件 是 对 任意 符合 几何 约束 的 虚 
位 移 ， 有 








SW=0 
注意 到 虚 位 移 8g 和 8X 并 不 是 独立 的 ， 是 符合 杆 件 的 几何 约束 条 件 的 。 利 用 式 (3-53 ) 
dX =.Jdg， 将 式 (3-63) 改 写成 





SW=7 5qg-F JS8g=(r-JF)'Sg (3-64) 
式 中 ，8d 表示 几何 上 人 允许 位 移 的 关节 独立 变量 ， 对 于 任意 的 8g ， 欲 使 8 到 =0， 必 有 
7=JF 


证 毕 。 


式 (3-64) 表 示 在 静 力学 平衡 状态 下 ， 手 部 端点 力 下 向 广义 关 市 力矩 7 映射 的 线性 关系 。 
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式 中 J 与 手 部 端点 力 F 和 广义 关节 力矩 7 之 间 的 力 传 递 有 关 ， 故 称 为 工业 机 器 人 力 雅 可 比 。 
很 明显 ， 力 雅 可 比 J 正好 是 工业 机 器 人 速度 雅 可 比 y 的 转 置 。 


四 、 工 业 机 器 人 静 力学 的 两 类 问题 
从 操作 辟 手 部 端点 力 与 广义 关节 力矩 之 间 的 关系 式 7=J'F 可 知 ， 操 作 辟 静 力学 可 


分 为 两 类 问题 : 

1) 已 知 外 界 环 境 对 工业 机 侣 人 手 部 作用 力 严 ( 即 手 部 端点 力 忆 = -下 ')， 求 相应 的 满足 
静 力 学 平衡 条 件 的 关节 驱动 力矩 r。 

2) 已 知 关节 驱动 力矩 7， 确 定 工业 机 旧 人 手 部 对 外 界 环境 的 作用 力 或 负 符 的 质量 。 
第 二 类 问题 是 第 一 类 问题 的 逆 解 。 这 时 

po A 

但 是 ， 由 于 工业 机 各 人 的 自由 度 可 能 不 是 6， 比 如 n>6， 力 雅 可 比 矩 阵 就 有 可 能 不 是 一 个 方 
阵 ， 则 J 就 没有 逆 解 。 所 以 ， 对 这 类 问题 的 求解 就 困难 得 多 ， 在 一 般 情 况 下 不 一 定 能 得 到 
唯一 的 解 。 如 果 正 的 维 数 比 r 的 维 数 低 ， 晶 /是 满 秩 ， 则 可 利用 最 小 二 乘法 求 得 FP 的 估 
值 。 

















工业 机 副 人 动力 学 人 研究 的 是 各 杆 件 的 运动 和 作用 力 之 间 的 关系 。 工 业 机 各 人 动力 党 分析 





是 工业 机 带 人 设计 、 运 动 仿真 和 动态 实时 控制 的 基础 。 

为 了 控制 机 器 人 ， 仅 有 机 需 人 运动 学 的 基础 是 远 远 不 够 的 ， 还 必须 建立 起 其 动力 学 方 
程 。 工 业 机 需 人 的 动力 学 问题 主要 是 人 研 究 机 事 人 各 关节 的 关节 位 置 、 关 节 速 度 、 关 节 加 速度 
与 各 关节 执行 项 驱动 力矩 之 间 的 关系 。 研 究 的 主要 目的 是 解决 如 何 控制 工业 机 般 人 ， 同 时 为 
工业 机 融 人 的 最 优化 设计 提供 有 力 的 证 据 。 

机 各 人 的 动力 学 有 两 个 相反 的 问题 一 是 动力 学 问题 ， 已 知 机 船 人 位 置 速度 、 加 速度 ， 
求 相 应 的 关节 力矩 相 量 ， 用 正和 运动 学 来 确定 机 从 人 末端 手 的 位 姿 ， 称 为 动力 学 正 问题 ; 二 是 
相反 的 问题 是 已 知 关 节 力 和 矩 ， 求 机 天 人 的 位 置 、 速 度 和 加 速度 。 

研究 动力 学 的 重要 目的 之 一 是 对 机 需 人 的 运动 进行 有 效 控 制 ， 以 实现 预期 的 轨迹 运动 ， 
所 以 在 动力 学 算法 的 研究 中 ， 本 书 主要 介绍 逆 动 力学 问题 。 工 业 机 侣 人 作为 非常 复杂 的 动力 
学 系统 ， 目 前 已 提出 了 多 种 动力 学 分 析 方 法 ,分 别 基于 不 同 的 力学 方程 和 原理 ， 如 牛顿 - 欧 
拉 方 程 、 拉 格 明 日 方程 、 凯 恩 方 程 、 广 义 达 明 贝尔 原理 等 。 本 音 主 要 介绍 常用 的 牛顿 - 欧 拉 
方程 和 拉 格 明日 方程 。 


























第 一 卫生 频 - 欧 拉 方程 


现在 把 对 刚体 运动 的 分 析 推 广 到 加 速度 的 情况 。 在 任 一 瞬时 ， 线 速度 矢量 和 角速度 矢量 
的 导数 分 别称 为 线 加 速度 和 角 加 速度 。 即 
d ， wo(t +At) - “volt) 








B 和 . 
dt © A At We) 
和 
, dd 4D (t+At) -0,(1) 
10, =—0, = lim—— e (4-2) 
di Al 一 0 Ai 


正如 速度 的 情况 一 样 ， 当 求 导 的 参考 坐标 系 被 理解 为 某 个 宇宙 标 系 1 UVU ! 时， 将 用 下 
面 的 记号 


2 4 一 vy AORG (4-3) 
和 
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wn "0 (4-4) 
(一 ) 线 加 速度 
从 描述 当 原 点 重合 时 从 坐标 系 ! 4 ! 看 到 的 矢量 0 的 速度 


“vo =3R "vo + “(Ds 53R OO (43) 
这 个 方程 的 左边 描述 0 如 何 随时 间 而 变化 。 所 以 ， 因 为 原点 是 重合 的 ， 可 以 重 写 式 (4-5 ) 为 
STOR’Q) <IR ,+0, HR"O (4.6) 


这 种 形式 的 方程 式 当 推导 对 应 的 加 速度 方程 时 特别 有 用 。 
通过 对 式 (4-5 ) 求 导 ， 可 以 推出 当 1 4 与 1 有 8 + 的 原点 重合 时 ， 从 { 4 上 中 看 到 的 2O 
的 加 速度 表达 式 


® d bd d 
‘vo= (sR wo) + (02; sR OO+ 2 (oR “0) (4-7) 
现在 用 式 (4-6) 两 次 一 一 一 次 对 第 一 项 ， 一 次 对 最 后 一 项 。 式 (4-7) 的 右 侧 成 为 
sR vo + 0 sR vo + 0s sR "Q + 0s( sR vo +" 0 sR "OQ) (15) 
把 相同 两 项 合 起 来 
sR vo +2 "0 oR vo + "0 sR "QO + 0,("0, sR O) (4-9) 


最 后 ， 为 了 推广 到 原点 不 重合 的 情况 ， 加 上 一 项 给 出 1B1 原 点 的 线 加 速度 的 项 ， 式 4-7 
的 右 侧 得 到 


My porc + AR vo +2 0 AhR v0 + 0 RO +0,("0, AR QO) (4-10) 
对 于 将 在 本 章 上 考虑 的 情况 ， 总 是 有 ?@ 为 不 变 ， 或 
so =?9 =0 (4-11 ) 


所 以 ， 式 (4-10) 简 化 为 
‘90 = one + “2, (04 HR *Q) + "0, sR *Q (4-12) 
用 这 一 结果 来 计算 操作 机 杆 件 的 线 加 速度 。 
(二 ) 角 加 速度 
考虑 1 B | 以 “0Q; 相 对 于 ! 4 ! 转动 的 情况 , 而 1 C 1 以 “2 相对 于 1 B 1 转动。 为 了 
计算 “9。， 把 矢量 在 坐标 系 ! 4 | 中 相 加 
‘0, =°0,+sR "0Q. (4-13) 





求 导 后 得 到 


2 
25 = + sR “0, (4-14) 
1 





现在 ， 把 式 (4-6) 用 到 式 (4-14) 的 末 项 中 去 ， 得 到 
40 =402 +4R 0, +0, 4R 0. (4-15) 
把 这 个 结果 用 来 求 操 作 机 杆 件 的 角 加 速度 。 
把 操作 机 的 每 个 杆 件 考虑 为 刚体 。 如 果 知 道 杆 件 质心 的 位 置 和 惯性 张 量 ， 则 它 的 质量 分 
布 特性 就 完全 表示 出 来 了 。 为 了 使 这 些 杆 件 运动 ， 必 须 使 它们 加 速 或 减速 。 对 于 这 种 运动 所 
需 的 力 是 期 望 的 加 速度 和 杆 件 质量 分 布 的 函数 。 牛 顿 方程 和 回转 用 的 与 它 类 似 的 欧 拉 方 程 描 
述 了 力 、 惯 性 和 加 速度 之 间 是 什么 样 的 关系 。 





\ 工业 机 器 人 技术 应 用 


二 、 和 牛顿 - 欧 拉 方程 


(一 ) 牛顿 方程 
图 4-1 所 示 为 一 刚体 ， 其 质心 以 加 速度 w 在 加 速 运动 。 
在 这 种 情况 下 ， 作 用 在 质心 的 造成 这 个 加 速度 的 力 环 可 以 由 牛顿 方程 给 出 为 
F = move (4-16) 
式 中 ,，m 为 刚体 的 总 质量 。 
(二 ) 欧 拉 方程 
图 4-2 所 示 为 一 刚体 以 角速度 。 (2 < 
回转 着 ， 角 加 速度 为 w。 
在 这 样 的 情况 下 ， 为 了 产生 这 个 
运动 必须 施加 在 刚体 上 的 力矩 M 可 由 
欧 拉 方程 给 出 即 RE 
M=“lJo+wx‘lo (4-17) 
式 中 ，27 为 种 载 标 架 1C1 中 刚体 的 惯 
性 张 量 ，{ C} 的 原点 位 于 质心 ， 如 图 
4-2 所 示 。 
现在 考虑 计算 对 应 于 给 定 操作 机 
轨迹 的 扭矩 的 问题 。 假 定 已 知 关节 的 
位 置 、 速 度 和 加 速度 (9、6、6 ) 。 根 
据 这 些 知 识 以 及 机 器 人 运动 学 的 知识 、 加 42 克拉 方程 
质量 分 布 的 信息 等 ， 可 以 计算 出 造成 
这 个 运动 所 需 的 关节 扭矩 。 
(三 ) 向 前 迭代 以 计算 速度 和 加 速度 
为 了 计算 作用 在 杆 件 上 的 惯性 力 ， 需 要 计算 在 每 个 给 定 瞬 时 ， 操 作 机 各 杆 件 的 回转 速 
、 质 心 的 线 加 速度 和 回转 加 速度 。 这 些 计 算 将 以 迭代 式 的 形式 从 杆 1 开始 ， 逐 次 向 外 移 
动 ， 一 杆 接 一 杆 ， 直 到 杆 n。 
在 前 面 讨论 了 从 杆 件 到 杆 件 的 回转 速度 的 变换 ， 即 











六 


io = i + RO "2,, (4-18) 
从 式 (4-18) 得 到 从 杆 件 到 杆 件 的 角 加 速度 的 变换 方程 ， 即 
MR 0 0 (4-19) 
各 个 杆 的 线 加 速度 根据 式 (4-12) 可 以 得 到 为 
"lp "Ro PT xX( oO XP ) Fy,] (4-20) 
也 将 需要 各 个 杆 件 质心 的 线 加 速度 ， 它 也 可 由 应 用 式 (4-10) 求 出 ， 即 
Wa 的 区 Pe wmX( wi Ps) (4-21) 


式 中 ,假想 一 个 标 染 1C;| 固 结 于 各 个 杆 件 ， 而 它 的 原点 位 于 杆 件 质心 处 ， 而 且 与 杆 件 标 架 
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1 让 有 相同 的 方位 。 
注意 方程 式 应 用 于 杆 1 特别 简单 ， 因 为 "o = "ou =0。 
(四 ) 作用 在 杆 件 上 的 力 和 扭矩 
计算 出 各 个 杆 件 质心 的 线 加 速度 和 角 加 速度 后 ， 可 以 应 用 牛顿 - 欧 拉 方程 来 计算 作用 在 
各 个 杆 件 质心 上 的 力 和 扭矩 。 





F.= mv 
ee | (4-22 ) 
M,=" Jo+wx" lo 
式 中 ，! Ci| 的 原点 在 各 杆 的 质心 处 ， 而 它 的 方位 与 杆 件 标 架 ! i } 相同 。 
(五 ) 向 后 迭代 以 计算 力 和 扭矩 
计算 出 作用 在 各 杆 件 上 的 力 和 扭矩 后 ， 现 在 剩 下 有 要 做 的 是 计算 关节 扭矩 ， 它 们 将 产生 这 
些 作用 在 杆 件 上 的 净 力 和 扭矩 。 
根据 对 典型 杆 件 的 分 离 体 图 (图 4-3) 写 出 力 和 力矩 的 平衡 方程 式 就 可 以 计算 出 这 些 关 市 
扭矩 。 各 个 杆 件 受 到 其 相 邻 杆 件 所 施加 的 作用 力 和 扭矩 ， 还 承受 一 个 惯性 力 和 力矩 。 对 这 些 
邻 杆 的 作用 力 规定 特殊 的 符号 ， 即 
= 杆 件 i-1 作用 到 杆 件 i 的 力 
M;= 杆 件 i-1 作用 到 杆 件 i 的 力矩 


F 








T 
i 


图 4-3 典型 杆 件 的 分 离 体 图 


把 作用 在 杆 件 i 上 的 力 加 起 来 得 到 一 个 力 平 衡 关 系 ， 即 





F=f-inR fs (4-23) 
把 扭矩 对 于 质心 加 起 来 再 让 它们 等 于 和 零 ， 得 到 扭矩 平衡 方程 式 
Mme mt Po Xf Pn Da) Xa (4-24) 
从 力 平 衡 关 系 (4-23 ) 得 来 的 结果 再 加 上 几 个 回转 和 矩阵， 可 以 把 式 (4-24 ) 写 为 
1 0 /2B 0 nd NN Cy (4-25 ) 
最 后 ， 可 以 整理 力 和 扭矩 方程 式 使 它们 成 为 由 较 高 编号 连 杆 。 
ee Ne (4-26) 
m="M + R'm + Po x'F,+P,, XIR f, (4-27) 





这 些 方程 式 一 杆 接 一 杆 地 求 值 ， 从 杆 革 开始 向 机 融 人 的 基 座 进行 下 去 。 这 些 向 后 力 的 迭 
代 与 前 面 介 绍 过 的 静 力 欠 代 相似 ， 只 是 现在 考虑 了 各 杆 的 惯性 力 和 力矩 。 


NN Tm A 


如 同 静 力 的 情况 那样 ， 所 需 的 关节 扭矩 可 由 取 一 杆 作 用 于 其 邻 杆 的 扭矩 的 z 分 量 来 求 得 

T; = (4-28) 

注意 对 一 个 在 自由 空间 运动 的 机 器 人 ,，"* 大， 和 ”mi 都 让 它 为 零 ， 因 此 方程 式 的 第 一 

个 对 杆 革 的 应 用 非常 简单 。 如 果 机 需 人 与 周围 环境 有 接触 ， 由 于 接触 而 产生 的 力 和 扭矩 以 
"fi 和 "*m, ,i 不 等 于 零 而 包括 在 力 平衡 中 。 


三 、 和 迭代 的 牛顿 - 欧 拉 动力 学 算法 


由 关节 的 运动 来 计算 关节 扭矩 的 完整 的 算法 由 两 部 分 组 成 。 首 先 ， 杆 件 的 速度 和 加 速度 
从 杆 件 1 到 杆 件 寺 迭代 地 被 计算 出 来 ， 牛 顿 - 欧 拉 方程 式 被 用 于 各 个 杆 件 。 其 次 ， 反 力 和 反 
力矩 以 及 促 动 带 扭 从 从 杆 件 n 回 到 杆 件 1 递归 地 被 计算 出 来 。 这 些 方 程式 概括 如 下 : 
癌 前 : 0—5 





i+l itlpi iT 和 
ist =; RK owt+0 Zi41 (4-29) 
和 it+lpi™ it+lpi i+l 作 1 
Wi =; Rot+; RoxO Zi t+O Zi41 (4-30) 
Et i+1 证 i i i i i 
Dir1 =i RI wx P+ wxX( wx'P,,)+'v,] (4-31) 
ot _i+l ” i+1 万 i+1 i+1 itip iT 4.32 
Ve = Wirl X Ct Oil X( wi x -my +t Vixl (4-32) 
+1 +1 
Fi =miy Ve (4-33) 
i+l1 i+l1 ” i+l1 i+l1 
M,,i = COi+1l 十 COi+1 X 1 COi+1l (4-34 ) 
癌 后 i: 6—1 
i i i+1 i 
fi =;.R fest 十 上 (4-35) 
i i i+1 i i i i i+1 
m= M+tinR mt Pox Ft Pr Xiunk sr (4-36) 
i 
T; = :70;“ 公 ， (4-37 ) 


第 一 是” 拉 格 朗 日 太 程 


一 、 拉 格 朗 日 函数 


拉 格 明日 函数 工 的 定义 是 一 个 机 械 系 统 的 动能 EB 和 势能 ,之 差 ， 即 
L=E.-E. (4-38) 
令 g,(i=1，2，…, n) 是 使 系统 具有 完全 确定 位 置 的 广义 关节 变量 ，g, 是 相应 的 广义 关 
节 速 度 。 由 于 系统 动能 及 是 ,和 9; 的 函数 ， 系 统 势能 ,是 q; 的 函数 ， 因 此 拉 格 朗 日 函数 也 
是 4 和 9%; 的 函数 。 





二 、 拉 格 朗 日 方程 
系统 的 拉 格 明日 方程 为 
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d aL ooL 
ES 和 
di 09g; 90g; 
式 中 ，F; 称 为 天 节 红 的 广义 驱动 力 。 如 来 是 移动 天 市 ， 则 Fi 为 驱动 力 ; 如 琳 是 转动 天 市 ， 则 
让 为 驱动 力矩 。 





i ,2 (4-39) 


三 、 用 拉 格 朗 日 法 建立 工业 机 器 人 动力 学 方程 的 步 又 


1) 选取 坐标 系 ， 选 定 完全 而 且 独 立 的 广义 关 市 变量 g;(i=1, 2,…, n)。 

2) 选 定 相应 的 关节 上 的 广义 力 天 : 当 gq; 是 位 移 变 量 时 ， 则 Fi 为 力 ; 当 g; 是 角度 变量 时 ， 
则 Fj 为 力矩 。 

3) 求 出 工业 机 各 人 各 构件 的 动能 和 势能 ， 构 造 拉 格 明日 函数 。 

4) 代入 拉 格 朗 日 方程 求 得 工业 机 右 人 系统 的 动力 学 方程 。 


四 、 二 自由 度 平 面 关节 型 工业 机 器 人 动力 学 方程 





(一 ) 广义 关节 变量 及 广义 力 的 选 定 

选取 笛 卡 儿 坐 标 系 如 图 4-4 所 示 。 连 杆 1 和 连 杆 2 的 关节 变量 分 别 为 转角 和 和 9, ， 相 应 
的 关节 工 和 关节 2 的 力矩 是 7 和 7,。 连 杆 1 和 连 杆 2 的 0 
质量 分 别 是 ml 和 m,， 杆 长 分 别 为 4 和 71， 质心 分 别 在 C 
和 C 处 ， 离 相应 关节 中 心 的 距离 分 别 为 疡 和 疡 。 因 此 ， 
杆 工 质心 C 的 位 置 坐标 为 


x1 =pisinO, 





yi = 一 PicosOi 
杆 1 质心 CG 的 速度 平方 为 





wi +9 = (p101) 图 44 二 自由 度 工业 机 器 人 
杆 2 质心 C, 的 位 置 坐 标 为 动力 学 方程 的 建立 


x, =1sin0 +p,sin( 0, +0,) 
y, = -Licos0 ~-pscos( 0 +0,) 
杆 2 质心 C, 的 速度 平方 为 
x =1,cos0,0, +pcos( 0 +0,) (0, + 0,) 
yy =1ising,01 +posin(b +0,) (0 +0,) 
x + =00 +p? (0, +0,) +2lp,(t +0,0,)cos0, 


(二 ) 系统 动能 


1 . 
El = FMP Oo 


NN 工业 机 器 人 技术 应 用 


1 2 bg 1 2 0 S 2 “7 多 . 
El i 7272 (0 +0,) +m,lip, (O01 +010,)cos0, 
2 1 2 六 “7 1 2 Dd bd 2 “7 。 多 
Ek = > = i + mli)0 十 了 ”212 (0 +0,) + mlips(01 +00)cos0， 
A 
(三 ) 系统 势能 (以 质心 处 于 最 低位 置 为 势能 零点 ) 
| =ngpi(1 — cos0 ) 


bk, =m,gli(1 -cosO) ) +m,gpsl 1 —cos( 0 +0,)] 


2 
Ek, = 2 = (miPi + mli)g(l - cos0i) + mgpsll - cos(O0, + 0,)] 


(四 ) 拉 格 朗 日 函数 
L =E.-E, 


1 2 2 2 1 2 bd S 2 bp) 2 2 
0 + mli) 0 WA (0 +0,) +m,lips(01 +010,)cosg, 


- (mpi+mli)e(l -cos0) -mepsl 1 -cos(0, +0,)] 
(五 ) 系统 动力 学 方程 





根据 拉 格 明日 方程 
d oL 0/ 
及: 三 一 一 i=1,2,.…,n 
dt 9g; 09; 
可 计算 各 关节 上 的 力矩 ,得 到 系统 动力 学 方程 。 
计算 关节 1 上 的 力矩 7 , 即 
oL 和 Be 
a = (mpi+mli)0 +mp (0 +0,) +m,lip,(20, +0,)cos0, 
1 
oL 
i = — (mipit+nmli)gsing -mgpssin( 0, +0,) 
1 
所 以 
_ d ooL ooL 





网 dt a0, 00， 
= (mpi +mp; +m,D + 2m,lip,cos0, )0, + (mp + m,lip,cos0, ) 0, 玉 
(2mlipssing, O00, + -mlipsing, P+ mp, +ml) esing, + 
m,gpssin( 0, +0,) 
上 式 可 简写 为 
7 =D,0, +D,0, +D,00, +DyG +D, (4-40) 
由 此 可 得 
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Di =mpi + mp; + ml +2m,lip,cos0, 

Di, = mp; + m,lip,sing, 

Di = -2m,lip,sing, (4-41) 
Di» = —m,lip, sing, 


Di = (mipi + m,li ) gsing, + mgp,sin( 0, +0,) 





关节 2 上 的 力 和 7: 
oL 2 @ @ . 
— =mp(0, +0,) +m,lip,01co0s0, 
00， 
oL “7 @ 。 , > 
a = —m,lip,(01 +010,)sing, -mepssin( 0, +0,) 
2 
所 以 
_ d 9L oL 


7T2? 一 
dt 90， 00， 
= ( mp + m,lipscos0, ) 0, + mp? 0 十 [ (= mslip, + mlip, ) sing, ] 010, 


+ (m,lip,sing, ) 0 +m,gpsin( 0 +0,) 


上 式 可 简写 为 
7 =D,0, + D0, + D500, + Dt +D, (4-42) 
由 此 可 得 
D, = mp + m,lip,cos0, 
D = map’ 
Dy =( -mlip, +m,lip,)sing, =0 (4-43) 


1 = m,lip,sing, 
D, =m,gepssin( 01 + 0,) 


式 (4-40) ~ 式 (4-42 ) 分 别 表 示 了 关 世 驱动 力矩 与 关节 位 移 、 速 度 、 加 速度 之 间 的 关系 ， 
即 力 和 运动 之 间 的 关系 ， 称 为 图 4-4 所 示 二 自由 度 工 业 机 各 人 的 动力 学 方程 。 对 其 进行 分 析 
可 知 : 

1) 含有 6 或 09, 的 项 表示 由 于 加 速度 引起 的 关节 力矩 项 ， 其 中 : 

含有 Zhi 和 了 2 的 项 分 别 表 示 由 于 关节 1 加 速度 和 关节 2 加 速度 引起 的 惯性 力矩 项 ; 

含有 Do 的 项 表示 关节 2 的 加 速度 对 关节 1 的 耦合 惯性 力矩 项 ; 

含有 D2 的 项 表示 关节 1 的 加 速度 对 关节 2 的 耦合 惯性 力矩 项 。 

2) 含有 和 的 项 表示 由 于 向 心力 引起 的 关节 力矩 项 ， 其 中 : 

含有 Dis, 的 项 表示 关 广 2 的 速度 引起 的 向 心力 对 关节 1 的 耦合 力矩 项 ; 
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含有 Di 的 项 表示 关节 1 的 速度 引起 的 同心 力 对 关 市 2 的 耦合 力矩 项 。 

3) 含有 1 的 项 表示 由 于 哥 氏 力 引起 的 关节 力矩 项 ， 其 中 : 

含有 Di 的 项 表示 哥 氏 力 对 关节 1 的 耦合 力矩 项 ; 

含有 D 的 项 表示 哥 氏 力 对 关节 2 的 耦合 力矩 项 。 

4) 只 含 关节 变量 0 、9, 的 项 表示 重力 引起 的 关 市 力矩 项 。 其 中 : 

含有 Di 的 项 表示 连 杆 1、 连 杆 2 的 质量 对 关 方 1 引起 的 重力 矩 项 ; 

含有 D, 的 项 表示 连 杆 2 的 质量 对 关 市 2 引起 的 重力 窍 项 。 

很 复杂 ， 包 含 很 多 因素 ， 这 些 因素 都 在 影响 工业 机 带 人 的 动力 学 特性 。 对 于 复杂 一 些 的 
多 自由 度 工 业 机 适 人 ， 动 力学 方程 更 庞杂 ， 推 导 过 程 也 更 为 复 杀 。 不 仅 如 此 ， 对 工业 机 盏 人 
实时 控制 也 带 来 不 小 的 肪 烦 。 通 管 ， 有 一 些 简化 问题 的 方法 : 

1) 当 杆 件 质量 不 很 大 ， 重 量 很 轻 时 ， 动 力学 方程 中 的 重力 矩 项 可 以 省 略 。 

2) 当 关 节 速 度 不 很 大 ， 工 业 机 器 人 不 是 高 速 工业 机 器 人 时 ， 含 有 外 、 见 、 外 0 等 项 可 
以 省 略 。 

3) 当 关节 加 速度 不 很 大 ， 也 就 是 关节 电动 机 的 升降 速 不 是 很 突然 时 ， 那 么 售 9、9, 的 
项 有 可 能 给 予 省 略 。 当 然 ， 关 节 加 速度 的 减少 ， 会 引起 速度 升降 的 时 间 增 加 ， 延 长 了 工业 机 
船 人 作业 循环 的 时 间 。 
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六 六 六 六 六 六 六 六 人 六 从 六 人 六 人 六 人 六 信人 六 六 人 六 信人 六 人 六 人 六 六 六 人 六 六 六 人 六合 全 
CAA 人 ~ 人 ~ 人 ~A~ 人 ~_~ 


一 、 路 径 和 轨迹 


机 咒 人 的 轨迹 指 操作 臂 在 运动 过 程 中 的 位 移 、 速 度 和 加 速度 。 路径 是 机 器 人 位 姿 的 一 定 
序列 ， 而 不 考虑 机 器 人 位 姿 参数 随时 B 
间 变 化 的 因素 。 如 图 4-5 所 示 ， 如 果 有 
关机 器 人 从 4 点 运动 到 PB 点 , 再 到 CC 14 
点 ， 那 么 这 中 间 位 姿 序 列 就 构成 了 一 e 
条 路 径 。 而 轨迹 则 与 何 时 到 达 路 径 中 
的 每 个 部 分 有 关 ， 强 调 的 是 时 间 。 因 
此 ， 图 4-5 中 不 论 机 器 人 何 时 到 达 B 点 图 4-5 机 各 人 轨迹 图 
和 C 点 ， 其 路 径 是 一 样 的 ， 而 轨迹 则 依赖 于 速度 和 加 速度 ， 如 果 机 顺 人 抵达 已 点 和 C 点 的 
时 间 不 同 ， 则 相应 的 轨迹 也 不 同 。 研 究 不 仅 要 涉及 机 顺 人 的 运动 路 径 ， 而 且 还 要 关注 其 速度 
和 加 速度 。 


二 、 轨 迹 规 划 


轨迹 规划 是 指 根据 作业 任务 要 求 确定 轨迹 参数 并 实时 计算 和 生成 运动 轨迹 。 轨 迹 规 划 的 
一 般 问 题 有 三 个 : 

1) 对 机 大人 的 任务 进行 描述 ， 即 运动 轨迹 的 描述 。 

2) 根据 已 经 确定 的 轨迹 参数 ， 在 计算 机 上 模拟 所 要 求 的 轨迹 。 
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3) 对 轨迹 进行 实际 计算 ， 即 在 运行 时 间 内 按 一 定 的 速率 计算 出 位 置 、 速 度 和 加 速度 ， 
从 而 生成 运动 轨迹 。 

在 规划 中 ， 不 仅 要 规定 机 器 人 的 起 始点 和 终止 点 ， 而 且 要 给 出 中 间 点 (路 径 点 ) 的 位 姿 
及 路 径 点 之 间 的 时 间 分 配 ， 即 给 出 两 个 路 径 点 之 间 的 运动 时 间 。 

轨迹 规划 既 可 在 关节 空间 中 进行 ， 即 将 所 有 的 关节 变量 表示 为 时 间 的 函数 ， 用 其 一 阶 、 
二 阶 导 数 描述 机 器 人 的 预期 动作 ， 也 可 在 直角 坐标 空间 中 进行 ， 即 将 手 部 位 姿 参 数 表示 为 时 
间 的 函数 ， 而 相应 的 关节 人 位置、 速度 和 加 速度 由 手 部 信息 导出 。 

以 二 自由 度 平面 关节 机 器 人 为 例 解释 轨迹 规划 的 基本 原理 。 如 图 4-6 所 示 ， 要 求 机 髓 人 
从 4 点 运动 到 B 点 。 机 器 人 在 4 点 时 形 位 角 为 a =20°, B=30°; 到 达 B 点 时 的 形 位 角 是 a = 
40"，B =80°。 两 关节 运动 的 最 大 速率 均 为 10%/s。 当 机 器 人 的 所 有 关节 均 以 最 大 速度 运动 
时 ,下 方 的 连 杆 将 用 2s 到 达 ， 而 上 方 的 连 杆 还 需 再 运动 3s， 可 见 路 径 是 不 规则 的 ， 手 部 掠 
过 的 距离 点 也 是 不 均匀 的 。 

设 机 器 人 手臂 两 个 关节 的 运动 用 有 关公 共 因 子 做 归 一 化 处 理 ， 使 手臂 运动 范围 较 小 的 关 
节 运 动 成 比例 地 减 慢 ， 这 样 ， 两 个 关节 就 能 够 同 yy 
步 开 始 和 结束 运动 ， 即 两 个 关节 以 不 同 速度 一 起 
连续 运动 ， 速 率 分 别 为 4%/s 和 10°%/s。 如 图 4-6 
所 示 为 该 机 器 人 两 关节 运动 轨迹 ， 与 前 面 不 同 ， 
其 运动 更 加 均衡 ， 且 实现 了 关节 速率 归 一 化 。 

如 果 和 希望 机 器 人 的 手 部 可 以 沿 4B8 这 条 直线 
运动 ， 最 简单 的 方法 是 将 该 直线 等 分 为 几 部 分 
(图 4-6 中 分 成 5 份 ) ， 然 后 计算 出 各 个 点 所 需 的 
形 位 角 a 和 BB 的 值 ， 这 一 过 程 称 为 两 点 间 的 插 
值 。 可 以 看 出 ， 这 时 路 径 是 一 条 直线 ， 而 形 位 角 图 4.6 机 器 人 关节 角度 
变化 并 不 均匀 。 很 显然 ， 如 果 路 径 点 过 少 ， 将 不 
能 保证 机 器 人 在 每 一 小 段 内 的 严格 直线 轨迹 ， 因 此 ， 为 获得 良好 的 轨迹 精度 ， 应 对 路 径 进行 
更 加 细致 的 分 割 。 由 于 对 机 器 人 轨迹 的 所 有 运动 段 的 计算 均 基 于 直角 坐标 系 ， 因 此 该 法 属 直 
角 坐 标 空间 的 轨迹 规划 。 


三 、 关 节 空 间 的 轨迹 规划 


(一 ) 三 次 多 项 式 轨迹 规划 

假设 机 需 人 的 初始 位 姿 是 已 知 的 ， 通 过 求解 逆 运 动 学 方程 可 以 求 得 机 需 人 期 望 的 手 部 位 
姿 对 应 的 形 位 角 。 奉 考虑 其 中 某 一 关 市 的 运动 开始 时 刻 i 的 角度 为 8， 和 硕 望 该 关节 在 时 刻 广 
运动 到 新 的 角度 0。 轨迹 规 划 的 一 种 方法 是 使 用 多 项 式 函 数 ， 以 使 得 初始 和 末 问 的 边界 条 件 
与 已 知 条 件 相 匹配 ， 这 些 已 知 条 件 为 9, 和 4 及 机 天 人 在 运动 开始 和 绪 束 时 的 速度 ， 这 些 速 
度 通常 为 0 或 其 他 已 知 值 。 这 四 个 已 知 信息 可 用 来 求解 下 列 三 次 多 项 式 方程 中 的 四 个 未 知 


量 ， 即 










































































0(1) =co tet +ot +et (4-44 ) 


这 里 初始 和 末端 条 件 是 


NN Tm A 


0 ) = 0 
DC ) = li 
(4-45 ) 
0(1) =0 
b(7 =0 
对 式 (4-44) 进行 求 导 得 
0(1) = cl +2ct +3crt (4-46) 
将 初始 和 末端 条 件 代 入 上 面 两 式 得 到 
0( 三 =c0 =0: 
0(t1) =co tote + ctf + ett =0, 
(4-47 ) 


0(1,) =ci =0 
0(1) =0 F260 3eslr =0 


通过 联 立 求解 这 四 个 方程 ， 得 到 方程 中 的 四 个 未 知 的 数值 ， 便 可 算出 任意 时 刻 的 关 市 位 
置 ， 控 制 右 则 据 此 驱动 关节 所 需 的 位 置 。 尽 管 每 一 关 市 是 用 同样 步 缀 分 别 进行 轨迹 规划 的 ， 
但 是 所 有 关 市 从 始 至 终 都 是 同步 驱动 。 如 果 机 器 人 初始 和 末端 的 速率 不 为 稚 ， 则 同样 可 以 通 
过 给 定数 据 得 到 未 知 的 数值 。 

(二 ) 抛物 线 过 渡 的 线性 运动 轨迹 

在 关节 空间 进行 轨迹 规划 的 另 一 种 方法 是 让 机 需 人 关节 以 恒定 速度 在 起 点 和 终点 位 置 之 
间 运 动 ， 轨 迹 方程 相当 于 一 次 多 项 式 ， 其 速度 是 常数， 加 速度 为 零 。 这 表示 在 运动 段 的 起 点 
和 终点 的 加 速度 必须 为 无 穷 大 ， 只 有 这 样 才能 在 边界 点 瞬间 产生 所 需 的 速度 。 为 避免 这 一 现 
象 出 现 ， 线 性 运动 段 在 起 点 和 终点 处 可 以 用 抛物 线 来 进行 过 渡 ， 从 而 产生 连续 位 置 和 速度 。 

假设 1 =0 和 时 刻 对 应 的 起 点 和 终点 位 置 为 9, 和 04， 抛物 线 与 直线 部 分 的 过 渡 段 在 时 
间 志和 去 -与 处 是 对 称 的 ， 得 到 























1  ， 
0(1) =co +cit a 


0(1) = Se 


0(t) = CC, 
显然 ， 这 时 抛物 线 运 动 段 的 加 速度 是 一 个 常数 ， 并 在 公共 点 4 和 B( 称 这 些 点 为 节点 ) 
上 产生 连续 的 速度 。 
将 边界 条 件 代 入 抛物 线段 的 方程 ， 得 到 
0(0) =0 =co 
b(0) =0U = ci 


0(71) = CC» 
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整理 得 
cl =0 (4-49 ) 


0(1) =0t se 


(1) = CC, 


显然 ， 对 于 直线 段 ， 速 度 将 保持 为 冲 数 ， 可 以 根据 驱动 硕 的 物理 性 能 来 加 以 选择 。 将 零 
切 速 度 、 线 性 段 常 量 速度 w 以 及 零 末 端 速度 代 人 式 (4-51) 中 ， 可 得 4 点 和 如 点 以 及 终点 的 
关节 位 置 和 速度 如 下 : 








2 
0 = 0. 十 了 2 


0, =C,t, = 
Op=04 +o[ (tt) -th] =0 +o(t -21,) (4-51) 
Os =0, 0 


0:=0s +(04—0;) 





0 =0 
由 上 式 可 以 求 得 
CO 
cj 三 一 
i (4-52) 
0,=0, +6 FO@(t =26) 
把 C2 代入 得 
WW), 
91=0+ (© Ji +o 24) (4-53) 
b 
进而 求 出 过 渡 时 间 如 : 
0;—0r.+owtr 
ty 和 (4-54) 





CU 


已 不 能 总 大 于 总 时 间 4 的 一 半 ， 否则 ， 在 整个 过 程 中 将 没有 直线 运动 段 ， 而 只 有 抛物 线 
加 速 段 和 抛物 线 减速 段 。 由 t, 表达 式 可 以 计算 出 对 应 的 最 大 速度 : 








2( 0 一 0 ) 
= 

如 有 果 初 始 时 间 不 是 零 ， 则 可 采用 平移 时 间 轴 的 方法 使 初始 时 间 为 寺 。 终 点 的 抛物 线段 和 
起 点 的 抛物 线段 是 对 称 的 ， 只 不 过 加 速度 为 负 ， 因 此 可 以 表示 为 


w (4-55) 


max 


bi -0 (4.56) 
其 中 ， c = w/t, 从 而 得 到 
_ 2 
0(1) 0 


6(1) = (tt) (4-57) 


(1) a 
ty 
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> 工业 机 吉 入 的 探 制 | 


工业 机 副 人 的 结构 是 一 个 空间 开 链 机 构 ， 其 各 个 关节 的 运动 是 独立 的 ， 为 了 实现 末端 点 
的 运动 轨迹 ， 需 要 多 关节 的 协调 运动 。 因 此 ， 其 控制 系统 与 普通 的 控制 系统 相 比 要 复杂 得 
多 ， 表 现在 : 

1) 机 天 人 的 控制 与 机 构 运 动 学 和 动力 学 密切 相关 。 机 大 人 手足 的 状态 可 以 在 各 种 坐标 下 
进行 描述 ， 应 根据 需要 选择 不 同 的 参考 坐标 系 ， 并 做 适当 的 坐标 变换 。 经 常 要 求解 正 辐 和 运动 学 
和 反 回 运动 学 的 解 ， 此 外 还 要 考虑 惯性 力 、 外 力 〈 包 括 重 力 ) 、 哥 氏 力 及 加 心力 的 影响 。 

2) 一 个 人 简单 的 机 各 人 至 少 要 有 3 ~5 个 目 由 度 ， 比 较 复 杂 的 机 需 人 有 十 几 个 甚至 儿 十 个 
自由 度 。 每 个 自由 度 一 般 包含 一 个 伺服 机 构 ， 它 们 必须 协调 运动 ， 组 成 一 个 多 变量 控制 系 
统 。 所 以 ， 工 业 机 带 人 的 控制 ,一 般 是 一 个 计算 机 控制 系统 ， 计 算 机 软件 担负 着 艰巨 的 任 
和 

3) 描述 机 各 人 的 状态 和 运动 的 数 竺 模型 是 一 个 非 线 性 模型 ， 随 着 状态 的 不 同和 外 力 的 
变化 ， 其 参数 也 在 变化 ， 各 变量 之 间 还 存在 耦合 。 因 此 ， 仅 仅 利用 位 置 财 环 是 不 够 的 ， 还 要 
利用 速度 甚至 加 速度 闭环 。 系 统 中 经 常 使 用 重力 补偿 、 前 馈 、 解 看 或 自 适应 控制 等 方法 。 

4) 机 需 人 的 动作 往往 可 以 通过 不 同 的 方式 和 路 径 来 完成 ， 因 此 存在 一 个 “最 优 ” 的 问 
题 。 较 高 级 的 机 人 硕 人 可 以 用 人 工 智 能 的 方法 ， 用 计算 机 建立 起 庞大 的 信息 库 ， 借 助 信息 库 进 
行 控制 、 决 策 、 管 理 和 操作 。 根 据 传 感 瑚 和 模式 识别 的 方法 获取 对 象 和 环境 的 工 况 ， 按 照 指 
定 的 指标 要 求 ， 目 动 选择 最 佳 的 控制 规律 。 

总 之 ， 机 天 人 控制 系统 是 一 个 与 运动 学 和 动力 学 原理 密切 相关 的 、 有 耦合 的 、 非 线性 的 
多 变量 控制 系统 。 由 于 它 的 特殊 性 ， 经 典 的 控制 理论 和 现代 控制 理论 都 不 能 照搬 使 用 。 相 信 
随 春 机 天 人 技术 的 发 展 ， 机 需 人 控制 理论 也 将 有 新 的 发 展 。 


第 一 书 工业 机 器 人 控制 方式 的 分 类 
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工业 机 融 人 控制 方式 的 选择 ， 是 由 工业 机 天 人 所 执行 的 任务 决定 的 ， 对 不 同类 型 的 机 天 
人 应 选择 不 同 的 控制 方法 。 工 业 机 带 人 控制 的 分 类 没有 统一 标准 ， 如 投 运 动 坐标 控 制 方式 
分 ， 有 关节 空间 运动 控制 、 直 角 坐 标 空间 运动 控制 ; 按 控制 系统 对 工作 环境 变化 的 适应 程度 
来 分 ， 有 程度 控制 系统 、 适 应 控制 系统 、 人 工 智能 控制 系统 ; 按 同时 控制 的 机 器 人 数量 来 
分 ， 可 分 为 单 控 系统 、 群 控 系 统 。 除 此 之 外 ,， 通 第 还 按 运 动 控制 方式 的 不 同 ， 将 机 般 人 分 为 
位 置 控 制 、 速 度 控制 、 力 (力矩 ) 控制 和 智能 控制 四 类 。 下 面 按 运动 控制 方式 做 具体 分 
析 。 
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一 、 位 置 控制 


工业 机 器 人 位 置 控制 方式 又 分 为 点 位 控制 和 连续 控制 两 类 ， 如 图 5-1 所 示 。 
(一 ) 点 位 控制 (PTP) 3 
这 种 控制 方式 的 特点 是 只 控制 工业 机 硕 人 末端 
执行 器 在 作业 空间 中 某 些 规定 的 离散 点 上 的 位 姿 。 
控制 时 只 要 求 工业 机 器 人 快速 、 准 确 地 实现 相 邻 各 
点 之 间 的 运动 ， 而 对 达到 目标 点 的 运动 轨迹 则 不 做 




















任何 规定 。 这 种 控制 方式 的 主要 技术 指标 是 定位 精 
度 和 运动 所 需 的 时 间 。 由 于 其 控制 方式 易于 实现 、 图 5-1 位 置 控制 方式 
定位 精度 要 求 不 高 的 特点 ， 因 而 常 被 应 用 在 上 下 a) 尽 位 控制 b) 连续 轨迹 控制 








料 、 搬 运 、 操 焊 和 在 电路 板 上 安插 元 件 等 只 要 求 目标 点 处 保持 末端 执行 带 位 姿 准 确 的 作业 
Hs 

(二 ) 连续 轨迹 控制 (CP) 

这 种 控制 方式 的 特点 是 连续 地 控制 工业 机 大 人 末端 执行 右 在 作业 空间 中 的 位 姿 ， 要 求 其 
严格 按照 预定 的 轨迹 和 速度 在 一 定 的 精度 范围 内 运动 ， 而 且 速 度 可 控 ， 轨 迹 光滑 ， 运 动 平 
稳 ， 以 完成 作业 任务 。 工 业 机 各 人 各 关 广 连续 、 同 步 地 进行 相应 的 运动 ， 其 末端 执行 右 即 可 
形成 连续 的 轨迹 。 这 种 控制 方式 的 主要 技术 指标 是 工业 机 需 人 未 闪 执 行 带 位 姿 的 轨迹 跟踪 精 
度 及 平稳 性 。 通 常 驳 焊 、 喷 漆 、 去 毛 边 和 检测 作业 机 顺 人 都 采用 这 种 控制 方式 。 


二 、 速 度 控制 


工业 机 和 右 人 按 预 定 的 指令 ， 控 制 运动 部 件 的 速度 和 实行 加 、 减 速 ， 以 满足 运动 平稳 、 定 
位 准确 的 要 求 。 为 了 实现 这 一 要 求 ， 机 磊 人 的 行程 要 杂 循 一 定 的 速度 变化 曲线 。 由 于 机 磊 人 
是 一 种 工作 情况 (行程 负载 ) 多 变 、 惯 性 负载 的 运动 机 械 ， 要 处 理 好 快速 与 平稳 的 矛盾 ， 
必须 控制 起 动 加 速 和 停止 前 的 减速 这 两 个 过 渡 运 动 区 段 。 


三 、 力 ( 力 答 ) 控制 


在 进行 装配 或 抓 取 物体 等 作业 时 ， 工 业 机 融 人 末端 操作 带 与 环境 或 作业 对 象 的 表面 接 
触 ， 除 了 要 求 准确 定位 之 外 ， 还 要 求 使 用 适度 的 力 或 力矩 进行 工作 ， 这 时 就 要 采取 力 ( 力 
和 矩 ) 控制 方式 。 这 种 方式 的 控制 原理 与 位 置 伺服 控制 原理 基本 相同 ， 只 不 过 输入 量 和 反馈 
量 不 是 位 置信 号 ， 而 是 力 (力矩 ) 信号 ， 因 此 系统 中 必须 有 力 〈 力 矩 ) 传 感 硕 。 有 时 也 利 
用 接近 、 滑 动 等 传 感 功能 进行 自 适应 式 控制 。 


四 、 智 能 控制 方式 
机 各 人 的 智能 控制 是 通过 传 感 带 获得 周围 环境 的 知识 ， 并 根据 上 自重 内 部 的 知识 库 做 出 相 


应 的 决策 。 采 用 智能 控制 技术 ， 使 机 般 人 具有 了 较 强 的 环境 适应 性 及 上 自学 习 能 力 。 智 能 控制 
技术 的 发 展 有 赖 于 近年 来 人 工 神经 网 络 、 基 因 算 法 、 遗 传 算法 、 专 家 系统 等 人 工 智能 的 迅速 
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工业 机 融 人 位 置 控制 的 目的 ， 束 是 要 使 机 需 人 各 关节 实现 预先 所 规划 的 运动 ， 最 终 保证 
工业 机 右 人 终端 ( 手 爪 ) 沿 预定 的 轨迹 运行 。 工 业 机 顺 人 大 多 为 串 接 的 连 杆 结构 ， 是 个 多 
输入 -多 输出 控制 系统 ， 其 动态 特性 具有 高 度 的 非 线性 。 现 把 每 个 关节 作为 一 个 独立 的 系统 ， 
因而 ， 对 于 一 个 具有 m 个 着 的 工业 机 天 人 来 将 ， 可 以 把 它 分 解 成 到 个 独立 的 单 输 入 - 单 输 
出 控制 系统 。 这 种 独立 关节 控制 方法 是 近似 的 ， 因 为 它 包 略 了 工业 机 釉 人 的 运动 结构 特点 ， 
即 各 个 关东 之 间 相 互 耦 合 和 随 形 位 变化 的 事实 。 如 果 对 于 更 高 性 能 要 求 的 机 需 人 控制 ， 则 必 
须 考 虑 更 有 效 的 动态 模型 、 更 高 级 的 控制 方法 和 更 完善 的 计算 机 体系 结构 。 


一 、 工 业 机 器 人 单 关 市 的 建 模 和 控制 


下 面 以 直流 伺服 电动 机 为 例 进行 分 析 。 

在 电 枢 绕组 等 效 电 路 图 5-2 和 机 械 传动 原理 图 5-3 中 ,wu 为 电 枢 电 压 ; wi 为 励磁 电压 ; 
LL, 为 电 枢 电 感 ; Li 为 励磁 绕组 电感 ; R, 为 电 枢 电阻 ;Ri 为 励磁 绕组 电阻 ; i, 为 电 枢 电流 ; 疼 
为 励磁 电流 ; e 为 反 电动 势 ; T, 为 电动 机 输出 力矩 ; 9， 为 电动 机 轴 角 位 移 ; 4 为 负载 轴 角 
位 移 ; J 为 折合 到 电动 机 轴 的 惯性 矩 ; 五 为 折合 到 负载 轴 的 负载 惯性 矩 ; /, 为 折合 到 电动 
机 轴 的 黏 性 摩 探 因数 ; 万 为 折合 到 负载 轴 的 黏 性 摩 控 因 数 ; z,, 为 电动 机 齿轮 齿 数 ; zi 为 负 
载 齿轮 齿 数 ; n=z,/zL，n 为 电动 机 轴 到 负载 轴 的 传动 比 。 
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图 5-2 电 枢 绕组 等 效 电路 图 图 5-3 ”机 械 传动 原理 图 


从 电动 机 轴 到 负载 轴 的 传动 比 为 n， 则 折算 到 电动 机 轴 上 的 总 惯性 矩 Jur 及 等 效 黏 性 摩 
擦 因数 .1 为 
Lr 二 六 (5-1) 
fr =f, +nf (52) 
电 枢 绕组 的 电压 平衡 方程 式 为 


di, (1) 


U,(t) =R,i(t) +L, 





+e,(t) (5-3) 


电动 机 轴 力 矩 平 衡 方程 式 为 


\ 工业 机 器 人 技术 应 用 


T, (1) =Ja0 +fn0, (5-4) 
机 械 部 分 与 电气 部 分 的 耦合 包括 两 个 方面 : 电动 机 轴 上 产生 的 力矩 与 电 枢 电 流 成 正比 ， 
电动 机 的 反 电动 势 与 电动 机 的 角速度 成 正比 ， 即 
T(t) =k,i,(t) (53 
es(t) =k,0, (1) (5-6) 
式 中 ,为 电动 机 的 电流 -力矩 比例 常数 (N. m/A); 为 电动 机 的 反 电动 势 比 例 常数 [ V/ 
(rad/s) | 。 
对 式 (5-3) ~ 式 (5-6) 进 行 拉 普 拉 斯 变换 并 化 简 ， 得 到 从 电 枢 电压 到 电动 机 轴 角 位 移 的 开 
环 传递 函数 为 





0(S) kh, 
U,(s) cs[ sal, + (Lfn + Rn)s t+R fn t+ kh 
由 于 电动 机 的 电气 时 间 常 数 大 大 小 于 其 机 械 时 间 和 常数 ， 因 此 可 以 忽略 电 枢 的 电感 L 的 
作用 ， 可 将 上 面 的 方程 式 (5-7) 简 化 为 





(5-7) 














0 (35) 人 天 
加 (S-8 ) 
U(s) s(sRJa t+Rfas thkk,) SC7Tas+1I) 
h 
: oa = - 
式 中 ， 电 动机 增益 常数 为 0 
本 人 /aa 
电动 机 时 间 常 数 为 人 
电 枢 电压 U,(s) 与 关 市 角 位 移 9.(;) 之 间 的 传递 函数 为 
Oi(s nk, 
(s) (5.9) 





U.,(s) ss (sR + Rfur + 
系统 方 框图 如 图 5-4 所 示 。 





图 5-4 单 关节 开 环 传递 函数 


二 、 单 关 市 位 置 探 制 器 


位 置 控制 紫 的 作用 是 利用 电动 机 组 成 的 伺服 系统 使 关 方 的 实际 角 位 移 0. 跟踪 期 望 的 角 
位 移 91。 把 伺服 误差 作为 电动 机 的 输入 信和 号， 产生 适 当 的 电压 ， 构 成 闭环 系统 ， 即 
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1 -CD [ECD -9 人 a 


式 中 ， ,为 位 置 反 馈 增 益 (V/rad); e(1) = 0L(1) -0.() 为 系统 误差 ; n 为 传动 比 。 
这 样 束 可 以 利用 负载 轴 的 角 位 移 负 反馈 把 单 关节 机 各 人 的 控制 从 开 环 系统 转变 为 闭环 系 
统 ， 如 图 5-5 所 示 。 关 节 有 角度 可 用 位 置 传 感 硕 如 光电 人 码 盘 等 测 出 。 


04(s) Ee Tn(s) SOm(s) Om(s) 











图 5-5 人 带 位 置 反馈 的 闭环 控制 方 框图 





对 式 (5-10 ) 进行 拉 善 拉 斯 变换 ， 再 根据 图 5-5 可 得 出 误差 驱动 信号 5(s) 与 实际 角 位 移 
01.(s) 之 间 的 开 环 传递 函数 ， 即 
0.(s) hk, 
($5-11) 
(Cs ) os (sR + RJ or + kk ) 
由 此 可 得 位 移 反 馈 时 的 闭环 传递 函数 ， 它 表示 实际 角 位 移 与 期 望 角 位 移 之 间 的 关系 。 
01(s) G(s) kk, 
Or(s ) +C(s 三 5 RJ +s(Rfun + hk,k, ) + kk, 

















kk /( RJ) 
3 +s(Rfor t+ hk, /RJ or) +h,k (CR. J rr) 


式 (5-12) 表 明 单 关节 机 器 人 的 位 置 控制 器 是 一 个 二 阶 系统 ， 当 系统 参数 均 为 正 时 ， 总 是 稳定 
的 。 为 了 改善 系统 的 动态 性 能 ， 减 小 静态 误差 ， 可 引入 角速度 作为 反馈 信号 。 关 节 角 速度 可 
以 用 测速 发 电机 测定 ， 也 可 以 用 两 次 采样 周期 内 的 位 移 数据 来 近似 表示 。 加 上 位 置 和 速度 负 
反馈 之 后 ， 关 节 电动 机 上 所 加 的 电压 与 位 置 误差 及 其 导数 成 正比 ， 即 
kse(t) +he(t) hlOL(t) -Ot)] +h [Ot) -0.(t)] 
U.(t) = = (5-13) 


Nn 


(5-12) 




















式 中 ,, 为 速度 反馈 增益 ; nn 为 传动 比 。 
这 种 闭环 控制 系统 的 框图 如 图 5-6 所 示 。 对 式 (5-13) 进行 拉 普 拉 斯 变换 ， 再 把 变换 后 的 

结果 代入 式 (5-8) 中， 得 到 
01(s) sh ke, + hk, 











= ($5-14) 
E(s) sR +s(R, far + kk, ) 
由 此 可 以 得 出 表示 实际 角 位 移 与 期 望 角 位 移 之 间 的 闭环 传递 函数 ， 即 
01.(s) hk,s +h,k, 
(5-15) 


0' (s) 52R +s(Rfur + k,k, +k,k, ) + hk, 
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图 5-6 ”人 带 位 置 反 馈 及 速度 反馈 的 闭环 控制 框图 


三 、 速 度 和 位 置 反馈 增益 的 确定 





二 阶 系统 的 特征 方程 具有 下 面 的 标准 形式 : 
s” +2é0w,s +wr =0 
式 中 ,& 为 系统 阻尼 比 ; w, 为 系统 的 无 阻尼 上 自然 频率 。 
在 式 (5-15 ) 中， 系统 的 闭环 传递 函数 特征 方程 为 
sR ts(Rfn thk, thk,) +hkk, =0 (5-16) 


与 标准 形式 比较 可 得 





2 hh, 

”JR 

R fw th hk, +hk, 
dl 


Rfur + hk, + hk, 





CU 





2é0, = 





由 上 两 式 可 得 
2 hk J aR, 


在 工业 机 紫 人 控制 系统 中 ， 为 了 安全 起 见 ， 希望 系统 具有 临界 阻尼 或 过 阻尼 ， 即 要 求 系 
统 阻 尼 比 1， 因 此 ， 当 





Rfur + hk; + kk, 
三 三 1 


2 kk,JaR, 
2 ~、 hk J rR, Rfur hk; 
三 
v 
k, 与 相关， 在 确定 时 要 考虑 操作 臂 的 结构 共振 频率 。 当 机 带 人 空 载 时 ， 惯 性 转 矩 为 1。， 
结构 共振 频率 为 oo ， 负 和 载 时 惯性 转 矩 为 Jr， 结 构 共 振 频 率 为 
Ws — Wo NM Jo/ J arr 
为 了 不 激 起 结构 共振 和 系统 共振 ， 一 般 选 择 闭 环 系 统 的 无 阻尼 自然 频率 w, 不 超过 关 市 
结构 共振 频率 w, 的 一 半 ， 即 


(5-17) 





w, 0. 5w. 


据 此 ， 调 整 位 置 反馈 增益 名， 而 且 应 是 各 >0( 位 置 反 馈 是 负 反 馈 )， 则 得 出 
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0 < (5-18) 
将 式 (5-18) 代 入 式 (5-17)， 则 


人 oo Rf ur — kk (5-19) 


a 





四 、 交 流 伺服 电动 机 的 单 关 市 控制 器 


以 三 相 Y 联结 AC 无 刷 电动 机 为 例 ， 需 要 对 三 相 绕 组 进行 控制 ， 因 此 可 以 得 到 图 5-7 所 
不 电流 控制 框图 。 










| 
| [ ~ - - | 
二 

十 


图 5-7 三 相 Y 连接 AC 无 刷 电 动机 电流 控制 框图 
Ki, 一 电流 信号 前 置 放大 系数 7,、7T,、7. 一 三 相 绕 组 产生 的 转 矩 Ki 一 电流 环 反馈 系数 
is、 读 、 记 一 三 相 绕组 电流 K 一 电流 调节 帮 放 大 系数 ”一 电动 机 轴 上 的 总 转动 惯量 
1 、L 请 、L、R、 有、R. 一 三 相 绕 组 要 求 的 电流 、 电 感 和 电阻 


4T7 


2 
K sing、 Kusin( 0- 1 天。 sn 人 0-— | 一 三 相 绕 组 的 转 逢 常数 


每 相 电流 为 正弦 波 ， 但 彼此 相差 120°， 即 sin9、Lisin(9 -25/3)、JLisin(9 -4n/3)。 
如 同 直流 伺服 电动 机 一 样 ， 交 流 伺 服 电 动机 的 绕组 由 电感 和 电阻 构成 ， 加 到 绕组 上 的 电 
流 与 电压 关系 仍 为 一 阶 惯性 环节 ， 即 





1 
| j> 
L +R 


每 相 电 流 乘 以 相应 的 转 窍 常数 就 是 该 相 产 生 的 转 矩 。 也 如 同 直流 电动 机 ， 反 电动 势 正 比 于 转 
速 ， 即 Ksing6w、Kisin(0 -27/3) w 和 Ksin(0-47/3) o 为 三 相 的 反 电 动 势 。 最 后 三 相 转 
和 矩 之 和 为 电动 机 总 转 窍 7。 这 样 一 个 三 相 丫 联结 AC 无 刷 电 动机 模型 就 如 图 5-8 所 描述 的 。 


NN Tm A 


从 图 5-8 结构 中 ， 可 得 出 下 面 方 程 
KK, sin0 








i A A [TsingK,.— Kii, J]K, 一 wK sing| | 
List+R, 


{Llisin(0 —27/3)K,..— Ki, ]K, — 
Ksin(0 -27/3) 
十 
Ls+R, | 





wR sin(0 -27/3)| 


| [Tsin(0 -47/3)K,. -Ki |Ks 





Ksin(0 一 4TZ3 ) 
a | (5-20) 
Ls+R. 
在 电动 机 制造 时 ， 总 是 保证 各 相 参 数 相 等 ， 即 
人 。 = 大 = 大 = 大 ， 
L,=L,=L.=L, (5-21) 
R, =R, =R. =AR, 





这 样 ， 可 以 把 图 5-7 转换 为 等 效 的 直流 伺服 电动 机 电流 控制 系统 结构 框图 ， 如 图 5-8 所 示 。 
可 以 根据 图 5-8 来 分 析 无 刷 电动 机 的 电流 控制 系统 。 但 关节 控制 系统 是 位 置 控制 系统 ， 所 
以 ， 要 在 电流 控制 基础 上 增加 位 置 负 反 馈 环 或 速度 、 位 置 负 反馈 环 ， 如 图 5-9 所 示 。 











图 5-9 AC 无 刷 电动 机 电流 、 速 度 、 位 置 控制 框图 
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第 三 书 工业 机 刘 人 的 力 ( 力 矩 ) 控 制 


一 、 问 题 的 提出 


在 喷漆 、 点 焊 等 机 敌人 作业 时 ， 机 需 人 把 持 工 具 汽 规 定 的 轨迹 运动 ， 机 天 人 末端 执行 天 
始终 不 与 外 界 物体 相 接 触 ， 这 时 ， 只 对 机 右 人 做 位 置 控 制 束 可 以 了 。 

然而 ， 在 装配 、 加 工 、 抛 区 等 作业 中 ， 工 作 过 程 中 要 求 机 佐 人 手 爪 与 作业 对 象 接触 ， 并 
保持 一 定 的 压力 。 此 时 ， 如 果 只 对 其 实施 位 置 控 制 ， 有 可 能 由 于 机 规 人 的 位 姿 误 差 及 作业 对 
象 放置 不 准 ， 或 者 使 手 爪 与 作业 对 象 脱离 接触 ， 或 者 使 两 者 相 碰 撞 而 引起 过 大 的 接触 力 ， 其 
结果 ， 不 是 机 禹 人 手 爪 无 效 移动 ， 就 是 造成 机 和 希 人 或 作业 对 象 的 损伤 。 对 于 这 类 作业 ， 一 种 
比较 好 的 控制 方案 是 : 控制 手 爪 与 作用 对 象 之 间 的 接触 力 。 这 样 ， 即 使 是 作业 对 象 位 置 不 准 
确 ， 也 能 保持 手 爪 与 作业 对 象 的 正确 接触 。 相 应 地 ， 对 机 人 硕 人 的 控制 ， 除 了 在 一 些 上 自由 度 方 
癌 进行 位 置 控制 外 ， 还 需要 在 另外 一 些 自 由 度 方向 进行 力 的 控制 。 

力 只 有 在 两 个 物体 接触 后 才能 产生 ， 因 此 力 控 制 是 首先 将 环境 考虑 在 内 的 控制 问题 。 

为 了 对 机 大 人 进行 力 控 制 ， 需要 分 析 机 右 人 手 爪 与 环境 的 约束 状态 ， 并 根据 约束 条 件 制 
定 控 制 策略 ; 环境 对 机 右 人 的 位 置 或 力 施 加 了 约束 后 ， 对 被 施加 了 约束 的 机 带 人 进行 控制 ， 
比 对 一 般 机 般 人 实施 控制 要 复杂 得 多 。 


二 、 约 束 条 件 


机 侣 人 所 受 的 约束 可 分 为 自然 约束 和 人 为 约束 两 种 。 

自然 约束 是 指 工具 与 外 界 环境 接触 时 自然 生成 的 约束 条 件 。 它 与 环境 有 关 ， 由 环境 的 几 
何 特 性 及 作业 特性 等 引起 的 对 机 各 人 的 约束 。 如 当 机 帮 人 手 不 与 静止 的 工作 平台 表面 接触 
时 ， 手 不 不 能 自由 地 通过 平台 表面 ， 这 就 在 平台 法 向 存在 一 种 自然 的 位 置 约束 ， 可 在 这 个 方 
回 施 加 力 控制 。 人 为 约束 是 一 种 人 为 施加 的 约束 ， 用 来 确定 作业 中 期 望 的 运动 轨迹 或 施加 的 
力 。 如 在 平台 平面 上 的 运动 轨迹 。 

人 为 约束 条 件 必须 与 自然 约束 条 件 相 适 和 应， 因为， 在 一 个 给 定 的 自由 度 上 不 能 同时 对 力 
和 位 置 实施 控制 。 因 此 ， 机 各 人 手 爪 在 工作 平台 上 完成 操作 作业 时 ， 人 为 约束 条 件 只 能 是 平 
台 表 面 的 路 径 轨迹 和 与 平台 垂直 方向 上 的 接触 力 。 

由 于 刚性 物体 之 间 的 接触 力 是 作用 于 系统 的 主要 力 ， 在 建立 力 约束 模型 时 ,， 仪 考虑 由 于 
接触 引起 的 作用 力 ， 忽 略 像 重 力 、 茶 些 摩擦 力 分 量 这 样 的 静态 力 。 

根据 机 帮 人 末端 执行 帮 与 工作 环境 的 接触 情况 ， 可 以 把 机 帮 人 的 任务 与 一 组 约束 相关 
联 。 例 如 ， 当 机 顺 人 末端 执行 硕 与 静止 的 刚性 表面 接触 时 ， 不 允许 通过 表面 ， 因 此 ， 一 个 固 
有 的 位 置 约束 存在 ; 如 果 表 面 是 光滑 的 ， 驶 不 可 能 对 手 施加 与 表面 相 切 的 力 。 

在 环境 的 接触 模型 中 ， 用 治 表面 法 向 的 位 置 约束 和 沿 表 面 切 向 的 力 约束 定义 一 个 广义 表 
面 (Ceneralized Surface)。 广 义 表面 吓 一 种 特殊 的 多 维 曲面 ， 它 的 维 数 可 以 分 为 位 移 和 力 两 大 


类 。 


为 了 便于 描述 约束 情况 ， 可 用 一 个 坐标 系 {C1 来 取代 这 一 广义 表面 ， 称 坐标 系 1C| 为 约 
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束 坐 标 系 。 它 总 是 处 于 与 菜 项 具体 任务 相关 的 位 置 ， 根 据 任务 的 不 同 ， 它 可 能 固定 在 环境 
中 ,或 与 末 问 执行 融 一 起 运动 。 

例如 近 螺 条 (图 5-10) ,约束 坐标 系 附着 在 螺钉 旋 具 刀 尖 上 ， 并且 
随 任 务 的 进展 与 它 一 起 运动 ， 定义 约束 坐标 系 1C1 的 y 轴 与 螺 铭 的 覃 
一 致 ， 螺 钉 头 面 为 广义 表面 。 








自然 约束 条 件 : x=0 z=0 沿 x、z 轴 位 移 
w= 0 ww,= 绕 x、y 轴 角 速度 
人 沿 y 轴 力 的 分 量 
绕 z 轴 的 力矩 分 量 ox 
人 为 约束 条 件 : y =0 沿 y 轴 位 移 
= 治 y、z 轴 力 的 分 量 
ms =0 m,=0 m=m 绕 xy< 轴 的 力矩 分 量 图 5-10 拧 螺 钉 操作 
WwW, = 绕 z 轴 的 角速度 及 约束 坐标 系 


在 目 然 约束 中 ， 茶 方向 如 果 力 约束 为 零 ， 就 能 治 该 方向 进行 运动 
控制 ; 反之 ， 如 果 运 动 约束 为 去， 必然 受 力 的 约束 ， 能 够 实施 力 的 控制 ， 即 力 的 约束 与 运动 
是 对 偶 的 。 人 工 约束 指出 了 能 够 实施 运动 和 力 控 制 的 方向 。 

自然 约束 和 人 为 约束 把 机 器 人 的 运动 分 成 两 组 正 交 的 特征 : 力 和 运动 ; 对 每 一 组 可 以 按 
不 同 的 准则 进行 控制 。 


三 、 力 的 控制 


机 各 人 手 爪 与 环境 相 接 触 的 力 控制 问题 ， 人 简化 为 一 个 质量 - 弹簧 的 力 控 制 问题 ， 如 图 5 
11 所 示 。 

假设 系统 是 刚性 的 ， 质量 为 m， 用 弹 渴 模型 表示 被 控 模 型 与 
环境 之 间 的 作用 ， 设 环境 的 刚度 为 k.。 用 .表示 未 知 的 干扰 力 ， 
而 人 表示 力 控 制 变量 ， 即 作用 在 弹簧 上 的 力 ， 有 








Js= ky 
描述 这 个 物理 系统 的 方程 为 图 5-11 质量 -弹簧 系统 
mx + kx+fy, =f 
由 Wa 
系统 方程 可 变 为 mktf +A+A =f 


后 面 就 可 以 利用 前 面 介绍 的 位 置 控制 方法 设计 力 控制 融和 进行 稳 态 分 析 。 

(一 ) 阻抗 控制 

阻抗 控制 的 概念 是 N. Hogan 在 1985 年 提出 的 。 它 在 系统 模型 中 引入 了 阻尼 项 。 机 械 阻 
抗 根据 所 选取 的 运动 量 可 分 为 位 移 阻 抗 ( 又 叫 动 刚度 ) 、 速 度 阻抗 和 加 速度 阻抗 (又 叫 有 效 质 
量 ) 三 种 。 把 末端 执行 带 与 环境 的 接触 看 成 由 惯量 - 弹 沉 -阻尼 三 项 组 成 的 阻 搞 系统。 期 望 力 
为 
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F,=KAX+BAX +MAX (S522) 


式 中 ，AX = 和 -X，Z 为 名 义 位置 , 为 实际 位 置 ， 它 们 的 差 AX 为 位 置 误差 ; K、B、M 
为 弹性 、 阻 尼 和 惯量 系数 和 矩阵， 一旦 K、B 入 被 确定 ， 则 可 得 到 笛 卡 儿 坐 标的 期 望 动态 响 
应 。 利 用 式 (5-22 ) 计算 关节 力矩 ， 无 需求 运动 学 逆 解 ， 而 只 需 计 算 正 运动 学 方程 和 雅 可 比 矩 
阵 的 道 J 。 

阻抗 控制 不 是 直接 控制 期 望 的 力 和 位 置 ， 而 是 通过 控制 力 和 位 置 之 间 的 动态 关系 来 实现 
柔顺 功能 。 这 样 的 动态 关系 类 似 于 电路 中 阻抗 的 概念 ， 因 而 称 为 阻抗 控制 。 

图 5-12 中 ， 当 阻尼 反馈 矩阵 Kp =0 时 ， 称 为 刚度 控制 。 











图 5-12 ”阻抗 控制 结构 图 





刚度 控制 是 对 机 器 人 操作 手 静 态 力 和 位 置 的 双重 控制 。 控 制 的 目的 是 调整 机 器 人 操作 手 
与 外 部 环境 接触 时 的 伺服 刚度 ， 以 满足 机 顺 人 顺应 外 部 环境 的 能 力 。 
用 刚度 矩阵 天, 来 描述 机 器 人 末端 作用 力 与 位 置 误差 的 关系 ， 即 
F(i) = 天 ,AIX 
式 中 ，K, 通常 为 对 角 阵 ， 即 K, = diag(K ，K,o，…，K,s ) 。 刚 度 控制 的 输入 为 末端 执行 带 
在 直角 坐标 中 的 名 义 位 置 ， 力 约束 则 隐 含 在 刚度 矩阵 KK, 中 ， 调 整 K, 中 对 角 线 元 素 值 ， 就 可 
改变 机 顶 人 的 顺应 特性 。 
对 角 刚 度 矩 阵 所 依附 的 直角 坐标 原点 称 为 刚度 中 心 ， 显 然 刚度 中 心 具 有 这 样 的 性 质 ， 即 
如 有 果 在 这 一 点 施加 力 ， 只 会 引起 治 力 方 向 上 的 平移 运动 ， 如果 对 通过 该 点 的 坐标 轴 施 加 态 
和 矩 ， 只 会 产生 绕 该 轴 的 旋转 运动 。 但 由 于 刚度 矩阵 所 依附 的 坐标 可 以 任意 设置 ， 故 刚度 中 心 
位 置 也 可 任意 改变 。 
阻尼 控制 则 是 用 阻尼 矩阵 K, 来 描述 机 器 人 末端 作用 力 与 运动 速度 的 关系 ， 即 
E(k AX 
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式 中 ,K, 是 六 维 阻尼 系数 矩阵 ,通过 调整 K, 中 元 素 值 ,可 改变 机 器 人 对 运动 速度 的 阻尼 作用 。 
阻抗 控制 本 质 上 还 是 位 置 控 制 ， 因 为 其 输入 量 为 末端 执行 器 的 位 置 期 望 值 X%，( 对 刚度 
控制 而 言 ) 和 速度 的 期 望 值 X (对 阻抗 控制 而 言 ) 。 但 由 于 增加 了 力 反馈 控制 环 ， 使 其 位 置 
偏差 AX 和 速度 偏差 AX 与 末端 执行 器 与 外 部 环境 的 接触 力 的 大 小 有 关 ， 从 而 实现 力 的 闭环 
控制 。 这 里 力 -位 置 和 力 -速度 变换 是 通过 刚度 反馈 和 矩阵 Kw 和 阻尼 反馈 和 矩阵 Ko 来 实现 的 。 

(二 ) 位 置 / 力 混合 控制 

位 置 / 力 混合 控制 即 机 器 人 末端 执行 器 的 某 个 方向 因 环 境 关系 受到 约束 时 ， 同 时 进行 不 
受 方向 约束 的 位 置 控制 和 受 方向 约束 的 力 控 制 。 

位 置 / 力 混合 控制 的 基本 思想 : 沿 着 力 自然 约束 方向 ， 实 现 机 器 人 位 置 控 制 ， 沿 着 位 置 
自然 约束 方向 ， 实 现 机 器 人 的 力 控制 。 即 在 坐标 空间 将 任务 分 解 为 某 些 自由 度 的 位 置 控制 和 
另 一 些 自由 度 的 力 控制 ， 并 在 任务 空间 分 别 进行 位 置 和 力 控制 的 计算 ， 然 后 将 计算 结果 转换 
到 关节 空间 合并 为 统一 的 关节 控制 力矩 ， 即 在 任意 约束 坐标 系 1C} 的 正 交 自由 度 上 ， 实 施 
位 置 / 力 的 混合 控制 。 

在 环境 约束 情况 下 ， 对 机 器 人 进行 位 置 和 力 的 混合 控制 ， 通 常 要 先 建立 一 个 控制 曲面 ， 
即 所 谓 C 曲面 , 在 C 曲面 的 切线 方向 进行 位 置 控制 ， 而 沿 C 曲面 的 法 线 方向 进行 力 控制 ， 
如 图 5-13 所 示 。 

在 静态 情况 下 ，C 曲面 可 看 作 一 个 几何 问题 。 如 果 只 有 接触 
力 ， 且 机 器 人 定位 精度 已 知 ， 在 结构 化 环境 下 ， 就 能 确定 机 器 人 
以 什么 样 的 组 合 形 态 会 导致 它 与 环境 相 接 触 。 定义 N (qo) 为 C 
曲面 qo 点 的 法 线 方向 ， 则 在 接触 点 go 处 沿 N 轴 方 向 的 运动 会 导 
致 作用 力 增 大 ， 反 之 作用 力 减 小 。 因 此 沿 法 线 w 的 运动 可 控制 作 
用 力 的 大 小 。 以 混合 控制 的 观点 ， 找 到 了 C 曲面 的 法 线 W， 即 给 
出 了 力 控制 的 方向 。 而 位 置 控 制 则 不 能 越过 C 曲面 ， 它 只 能 沿 C 
曲面 接触 面 的 切线 方向 运动 。 因 此 沿 C 曲面 的 法 线 方向 进行 力 控 图 513 C 曲面 
制 ， 沿 切线 方向 进行 位 置 控制 ， 便 形成 了 位 置 / 力 混合 控制 的 控 
制 策略 。 这 样 就 把 位 置 / 力 混 合 控制 问题 变 成 了 如 何 确定 C 曲面 的 问题 。 

确定 C 曲面 ， 必 须 依据 具体 的 作业 任务 ， 把 末端 执行 器 受到 的 外 部 环境 的 自然 约束 条 
件 与 完成 作业 要 求 的 人 为 约束 条 件 结合 起 来 考虑 。 确 定 沿 法 线 方向 的 力 控制 和 沿 切线 方向 的 
位 置 控制 两 个 正 交 子 集 ， 这 些 正 交 子 集 便 构成 了 C 曲面 。 由 此 可 确定 机 器 人 的 控制 策略 和 
构造 控制 器 。 

图 5-14 是 由 Raibert 和 Craig 提出 的 一 种 位 置 / 力 控制 方案 ， 即 著名 的 R-C 控制 器 。 该 控 
制 器 不 同 于 刚度 控制 和 阻抗 控制 ， 阻 抗 控 制 和 刚度 控制 的 输入 是 位 置 和 速度 ， 其 力 控 隐 含 在 
刚度 反馈 和 矩阵 中 ， 但 本 质 还 是 属于 位 置 控制 。 而 R-C 控制 器 的 输入 变量 既 有 人 位置、 速度， 
也 有 力 。 

图 5-14 中 ， 机 器 人 各 关节 驱动 电动 机 的 力矩 分 别 由 位 置 环 (上 部 ) 和 力 控制 环 (下 
部 ) 这 两 个 相对 独立 的 控制 环 共同 提供 。 位 置 环 由 PI 调节 器 整定 ， 而 力 控制 环 由 带 限 幅 
器 的 P 调节 器 整定 ， 给 定 力 通过 雅 可 比 和 矩阵 转换 直接 加 到 关节 驱动 器 。 关 节 位 置 g 和 速 
度 由 光电 码 盘 或 测速 发 电机 提供 。 用 雅 可 比 和 矩阵 转换 为 直角 坐标 变量 “x 和 ?“x， 力 反馈 信 
号 由 腕 力 传感器 测 取 允 ， 通 过 坐标 变换 为 C 坐标 系 力 向 量 “f。 图 5-14 中 的 s 为 6x6 的 对 
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角 阵 ， 即 ss=diag (si ，s,，…，56) ， 称 为 顺应 选择 和 矩阵， 其 对 角 线 元 素 为 1 或 0， 由 它 来 
确定 (选择 ) 哪些 自由 度 施 加 力 控 ， 哪 些 上 自由 度 施加 位 置 控制 。 了 是 6 x6 的 单位 矩阵 。 
所 以 IT-s 是 选择 矩阵 s 的 逆 。 





由 于 机 融 人 的 控制 过 程 中 涉及 大 量 的 坐标 变换 和 插 补 运算 以 及 较 低层 的 实时 控制 ， 所 
以 ， 目 前 的 机 天 人 控制 系统 在 结构 上 大 多 数 采 用 分 层 结构 的 微型 计算 机 控制 系统 ， 通 常 采 用 
的 是 两 级 计算 机 伺服 控制 系统 。 机 需 人 控制 系统 硬件 结构 如 图 5-15 所 示 。 





二 级 (下 位 机 ) 
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一 级 (上 位 机 ) 
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图 5-15 机 器 人 控制 系统 硬件 结构 


机 个 人 控制 系统 具体 的 工作 过 程 是 主 控 计算 机 接 到 工作 人 员 输 入 的 作业 指令 后 ， 首 先 
分 析 解 释 指令 ， 确 定 手 的 运动 参数 ， 然 后 进行 运动 学 、 动 力学 和 插 补 运算 ， 最 后 得 出 机 耸 人 
各 个 关 厄 的 协调 运动 参数 。 这 些 参 数 经 过 通信 电路 输出 到 伺服 控制 级 作为 各 个 关节 伺服 控制 
系统 的 给 定 信号 。 关 节 驱 动 右 将 此 信号 D-A 转换 后 驱动 各 个 关 市 产生 协调 运动 ， 并 通过 传 
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感 郑 将 各 个 关节 的 运动 输出 信号 反馈 回 伺服 控制 级 计算 机 形成 局 部 闭环 控制 ， 从 而 更 加 精确 
地 控制 机 融 人 手 部 在 空间 的 运动 。 在 控制 过 程 中 ， 工 作 人 员 可 直接 监视 机 需 人 的 运动 状态 ， 
也 可 从 显示 融 等 输出 装置 上 得 到 有 关机 需 人 运动 的 信息 。 


一 、 上 位 机 《个 人 微机 或 小 型 计算 机 ) 
人 机 对 话 : 人 将 作业 任务 给 机 带 人 ， 同 时 机 各 人 将 结果 反馈 回来 ， 即 人 与 机 带 人 之 间 的 


FRV 


io 

数学 运算 : 机 器 人 运动 学 、 动 力学 和 数学 搬 补 运算 。 
通信 功能 : 与 下 位 机 进行 数据 传送 和 相互 交换 。 
数据 存储 : 存储 编制 好 的 作业 任务 程序 和 中 间 数 据 。 


二 、 下 位 机 (单片机 或 运动 控制 带 ) 


伺服 驱动 控制 : 接收 上 位 机 的 关节 运动 参数 信号 和 传 感 带 的 反馈 信号 ， 并 对 其 进行 比 
较 ， 然 后 经 过 误差 放大 和 各 种 补偿 ， 了 节 终 输出 关 贡 运动 所 需 的 控制 信 叶 。 图 5-16 为 CM-400 
运动 控制 紫 的 原理 框图 。 图 中 所 示 的 增 量 式 编码 带 的 A、B 相信 号 作为 位 置 反馈 输入 信和 号。 
运动 控制 仑 通过 四 倍 频 及 加 、 减 计数 套 得 到 实际 位 置 。 实 际 位 置 的 信息 保存 在 位 置 奇 存 套 
中 ， 上 级 计算 机 可 通过 控制 寄存 此 读 取 。 运 动 控 制 带 的 目标 位 置 由 上 级 计算 机 设 定 ， 通 过 内 
部 计算 得 到 位 置 误差 值 ， 经 过 数字 伺 服 滤波 各 后 ， 送 到 数 - 模 转 换 ( D-A) 融 或 脉 宽 调制 大 
(PWM) 人 硬件 处 理 电 路 ， 经 过 转换 ， 最 后 输出 伺服 电动 机 的 控制 信号 ， 即 + 10V 模拟 信号 或 


PWM 信号 。 
| 
数字 伺服 滤波 A > 
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图 5-16 GM-A400 运动 控制 融 的 原理 框图 


三 、 电 机 了 驱动 器 
功率 驱动 控制 : 提供 伺服 电动 机 电源 ， 控 制 电 动机 的 运转 方 回 及 速度 。 图 5-17 所 示 为 
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伺服 电动 机 驱动 系统 ， 其 中 虚线 框 部 分 为 伺服 电动 机 驱动 右 。 





位 置 传感器 


控制 电路 


图 5-17 伺服 电动 机 了 驱动 系统 
这 部 分 由 整流 逆 变 开关 电路 和 驱动 电路 组 成 。 驱 动 电路 的 作用 是 将 控制 电路 输出 的 脉冲 
进行 功率 放大 ， 以 控制 功率 晶体 管 的 通 断 。 整 流 逆 变 开关 电路 是 将 交流 电源 整流 后 ， 通 
变 天 输出 三 相 正 弦 电 压 ， 电 压 的 频率 、 相 位 和 幅 值 由 电动 机 转子 位 置 决定 。 


信号 
过 道 
四 、 关 市 电动 机 、 手 爪 及 传 感 融 

关节 电动 机 、 手 爪 及 传 感 融 各 部 分 功能 请 参照 第 二 音 有 关内 容 。 





一 千 寻 上 机 费 人 的 其 他 控制 单元 、 


人 六 六 六 六 六 人 六 全 
mA AAA AAA 


一 、 机 器 人 的 外 部 轴 控 制 


工业 机 做 人 控制 系统 的 主 探 单元 除了 可 以 负担 一 台 机 融 人 本 体 的 运动 控制 之 外 ， 还 能 负 
担 多 个 伺服 单元 的 有 关 控 制 。 扩 展 的 伺服 单元 含有 伺服 驱动 右 和 伺服 电动 机 ， 通 常 称 为 外 音 
轴 。 

在 机 佣 人 焊接 系统 中 变 位 机 的 位 置 变换 就 是 由 机 釉 人 的 外 部 轴 驱 动 的 。 增 加 的 外 部 轴 只 
能 使 用 工业 机 右 人 厂家 提供 的 产品 。 外 部 轴 增 加 的 数量 因 主 控 单 元 的 能 力 而 限定 。 如 MO- 
TOMAN 工业 机 和 右 人 的 控制 系统 ， 其 主 控 单元 可 控制 21 个 轴 。 这 就 是 说 ， 除 了 本 体 的 6 个 基 
本 轴 外 ， 还 可 接 15 个 外 部 轴 。 

外 部 轴 与 变 位 机 配合 ， 可 使 工件 变 位 或 移 位 ， 使 工件 的 多 个 侧面 处 于 最 佳 的 焊接 位 置 。 
机 船 人 可 以 安装 在 外 部 轴 驱 动 的 机 座 上 ， 以 扩大 动作 范围 ， 适 应 大 型 工作 。 帮 增加 6 个 外 部 
轴 驱 动 另 一 合 工业 机 希 人 本 体 ， 就 能 实现 双 机 协调 控制 。 

与 其 他 驱动 方式 相 比 ， 增 补 外 部 轴 的 突出 特点 是 通过 示 教 来 任意 定位 ， 并 保持 较 高 的 定 
位 精度 。 男 外 ， 外 部 轴 经 设 定 后 能 与 机 带 人 一 起 再 现 出 合成 轨迹 。 

机 如 人 外 部 轴 的 控制 并 非 一 个 独立 的 控制 系统 ， 实 际 上 与 本 体 轴 的 控制 是 一 样 的 ， 只 是 
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增加 了 轴 的 数量 而 已 ， 计 算 机 二 级 分 散 控制 框图 如 图 5-18 所 示 。 
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图 5-18 ”机 器 人 二 级 分 散 控制 框图 


二 、 机 器 人 视觉 焊 颖 跟踪 系统 


机 器 人 焊接 焊 缝 的 运动 路 径 规划 的 方法 有 多 种 ， 如 使 用 计算 机 离线 编程 后 下 载 到 控制 器 
中 实现 运动 的 方式 ， 或 是 示 教 系统 事先 规划 好 焊接 轨迹 来 控制 机 器 人 进行 焊接 ， 这 些 都 是 开 
环 控制 。 但 在 实际 焊接 中 ， 由 于 加 工 和 装配 误差 造成 的 焊 颖 位 置 和 尺寸 的 变化 ， 使 焊接 机 器 
人 无 法 按照 事先 编程 或 示 教 好 的 轨迹 进行 焊接 或 者 焊接 质量 下 降 。 因 此 在 复杂 空间 曲线 焊接 
中 ， 必 须 实现 焊 颖 的 准确 定位 。 

机 器 人 视觉 焊 颖 跟踪 原理 是 通过 安装 在 机 器 人 手臂 末端 的 激光 视觉 传感器 投射 激光 到 焊 
颖 上 ， 通 过 视觉 图 像 处 理 获 取 焊 颖 特征 点 ( 即 焊 颖 的 中 心 线 上 点 ) 的 坐标 ， 反 馈 给 机 器 人 
控制 问 ， 控 制 硕 连续 采集 并 对 特征 点 进行 曲线 拟 合 ， 随 时 通过 坐标 转换 确定 焊 颖 在 机 需 人 基 
础 坐标 系 的 位 置 ， 使 其 在 焊接 过 程 中 与 示 教 轨迹 比较 、 关 加 并 修正 跟随 实际 焊 缝 。 

(一 ) 机 器 人 视觉 焊 缝 跟踪 系统 组 成 

机 器 人 视觉 焊 颖 跟踪 系统 包括 n 关 厄 弧 焊 机 器 人 及 控制 器 ; 安装 在 机 器 人 手臂 末端 的 传 
感 器 系统 ， 包 括 激光 视觉 传感器 和 视觉 图 像 处 理 器 两 大 部 分 。 激 光 视 觉 传感器 又 由 激光 发 生 
器 和 CCD 摄像 机 构成 ， 如 图 5-19 所 示 。 

(二 ) 机 器 人 视觉 焊 缝 跟踪 系统 工作 原理 

激光 发 生 器 将 激光 条 纹 投影 于 带 有 焊 缝 的 工件 表面 ， 寻 找 焊 颖 起 点 ， 激 光 倾 斜 于 工件 表 
面 投射 ， 反 射 光 线 被 接收 到 CCD 摄像 机 中 。 若 焊 颖 出 现在 投射 光 带 扫描 宽度 范围 内 ， 则 可 
以 形成 图 像 ， 如 图 5-20 所 示 ， 图 像 是 焊 缝 的 轮廓 侧 向 截面 形状 。 如 果 超 出 一 个 光 带 扫描 宽 
度 范围 还 未 找到 焊 终 ， 传 感 器 系统 就 会 报错 ， 说 明 焊 颖 起 点 偏差 太 远 ， 需 要 重新 示 教 。 由 于 
激光 投射 角度 和 CCD 摄像 机 接收 角度 不 同 ， 根 据 三 角 测 量 原理 ， 可 以 获得 光 带 的 二 维 变形 
图 像 ， 扫 描 光 带 ， 如 图 5-20b 所 示 。 视 觉 图 像 处 理 器 中 软件 对 所 采集 的 图 像 与 预先 给 定 的 多 
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种 焊 颖 类 型 图 像 比 较 ， 确定 其 类 型 ， 并 提取 焊 颖 的 特征 点 ， 获 得 其 焊 颖 中 点 的 平面 坐标 ， 如 
图 5-20b 中 十 字 线 所 示 ， 并 将 特征 点 坐标 传送 到 机 甫 人 控制 带 中 。 通 过 坐标 转换 获得 焊 颖 的 


特征 点 在 机 需 人 坐标 系 中 的 坐标 。 
CCD 摄像 头 窗 
带 滤 光 片 透镜 
2 过 
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一 3 上 急 态 
扫描 光 带 a 
lat phe he 
A a F 
焊 颖 方向 
b) 
图 5-19 ”机 絮 人 焊 颖 跟踪 系统 原理 图 图 5-20 ”激光 扫描 原理 和 图 像 中 截面 形状 及 特征 点 





对 不 断 循环 扫 搬 连续 得 到 的 多 个 特征 点 进行 拟 合 和 插 补 即 可 确定 空间 焊 缝 在 机 带 人 坐标 
系 中 的 位 置 ， 从 而 获得 机 天 人 运动 的 轨迹 。 机 大 人 控制 部 驱动 机 大 人 各 关节 运行 示 教 程序 ， 
同时 按 传 感 磊 系统 发 出 的 焊 颖 特征 点 坐标 与 示 教 位 置 坐标 比较 ， 用 得 到 的 侦 差 修正 示 教 的 运 
行 轨迹 。 


三 、 机 器 人 的 智能 控制 


机 各 人 的 智能 控制 是 通过 传 感 带 获得 周围 环境 的 知识 ， 并 根据 自 映 内 部 的 知识 库 做 出 相 
应 的 决策 。 采 用 智能 控制 技术 ,使 机 侣 人 具有 较 强 的 环境 适应 性 及 自学 习 能 力 。 随 着 机 右 人 
应 用 领域 的 不 断 扩 大 ， 一 些 场合 对 机 大 人 提出 了 更 高 的 控制 要 求 。 

大 多 数 专家 认为 智能 机 器 人 至 少 要 具备 以 下 三 个 要 素 : 一 是 感觉 要 素 ， 用 来 认识 周围 环 
境 状态 ; 二 是 运动 要 素 ， 对 外 界 做 出 反应 性 动作 ; 三 是 思考 要 素 ， 根 据 感 觉 要 素 所 得 到 的 信 
中 ,思考 采用 什么 样 的 动作 。 感 觉 要 素 包 括 能 感知 视觉 、 接 近 、 距 离 的 非 接 触 型 传 感 幽 和 能 
感知 力 、 压 觉 、 触 觉 的 接触 型 传 感 副 。 这 些 要 系 实 质 上 就 相当 于 人 的 眼 、 蜡 、 征 等 五 官 ， 它 
们 的 功能 可 以 利用 诸如 摄像 机 、 图 像 传 感 副 、 超 声波 传 感 融 、 激 光 带 、 导 电 橡 胶 、 压 电 元 
件 、 气 动 元 件 、 行 程 开关 等 机 电 元 右 件 来 实现 。 对 运动 要 系 来 说 ， 智 能 机 带 人 需要 有 一 个 无 
轨道 型 移动 机 构 ， 以 适应 诸如 平地 、 人 台阶 、 墙 壁 、 楼 梯 、 坡 道 等 不 同 的 地 理 环境 。 它 们 的 功 
能 可 以 借助 轮子 、 履 市 、 文 脚 、 吸 盘 、 气 垫 等 移动 机 构 来 完成 。 在 和 运动 过 程 中 要 对 移动 机 构 
进行 实时 控制 ， 这 种 控制 不 仅 要 包括 位 置 控 制 ， 而 且 还 要 有 力 控制 、 位 置 与 力 混合 控制 及 伸 
缩 率 控制 等 。 稼 能 机 各 人 的 思考 要 系 是 三 个 要 系 中 的 关键 ,也 是 应 赋予 机 各 人 的 必 备 要 系 。 
思考 要 素 包括 判断 、 逻 辑 分 析 、 理 解 等 方面 的 智力 活动 。 这 些 智力 活动 实质 上 是 一 个 信息 处 
理 过 程 ， 而 计算 机 则 是 完成 这 个 处 理 过 程 的 主要 手段 。 
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智能 机 器 人 根据 智能 程度 的 不 同 又 可 分 为 三 种 。 

1. 传 感 型 机 器 人 

有 具 有 利用 传 感 信息 (包括 视觉 、 听 觉 、 触 觉 、 接 近 觉 、 力 觉 和 红外 、 超 声 及 激光 等 ) 
进行 传 感 信息 处 理 及 实现 控制 与 操作 的 能 力 。 

2. 交互 型 机 器 人 

机 器 人 通过 计算 机 系统 与 操作 员 或 程序 员 进 行人 -机 对 话 ， 实 现 对 机 需 人 的 控制 与 操作 。 

3， 上 自主 型 机 器 人 

在 设计 制作 之 后 ， 机 需 人 无 顷 人 的 干预 ， 能 够 在 各 种 环境 下 自动 完成 各 项 拟人 任务 。 

智能 机 器 人 的 研究 从 20 世纪 60 年 代 初 开始 。 经 过 几 十 年 的 发 展 ， 目 前 ， 基 于 感觉 控制 
的 智能 机 右 人 (又 称 第 二 代 机 右 人 ) 已 达到 实际 应 用 阶段 ;基于 知识 控制 的 智能 机 硕 人 
(又 称 自主 机 器 人 或 下 一 代 机 器 人 ) 也 取得 较 大 进展 ， 已 研制 出 多 种 样机 。 

因为 机 絮 人 动力 学 特性 的 高 度 复杂 性 ， 使 一 般 控 制 技术 性 能 降低 或 失效 ， 所 以 需 人 研究 具 
有 自 适 应 和 学 习 智 能 的 高 级 机 絮 人 控制 技术 。 近 年 来 用 于 机 絮 人 的 高 级 技术 主要 有 : 

(1) 滑 腊 和 自 适应 控制 技术 其 特点 是 不 确定 对 象 控制 ， 高 度 鲁 棒 性 ， 参 数 的 实时 校 
正 ， 优 秀 的 动态 控制 性 能 ， 稳 定性 分 析 复 办。 

(2) 学 习 控制 技术 其 特点 是 基于 感知 信息 ， 黑 箱 控制 ， 具 有 学 习 构 成 和 优化 动态 控制 
和 硕 的 能 力 。 

(3) 模糊 控制 技术 其 特点 是 黑箱 控制 ， 较 好 的 鲁 棒 性 ， 优 于 PID 的 动态 性 能 ， 可 与 专 
家 系统 和 神经 网 络 技 术 结 合 实现 一 定 的 学 习 功 能 。 

(4) 神经 网 络 控制 技术 ”其 特点 是 黑箱 控制 ， 较 好 的 鲁 棱 性 ， 具 有 学 习 能 力 。 

此 外 ， 还 有 一 些 新 的 控制 技术 ， 因 为 篇 幅 所 限 ， 下 面 重点 介绍 模糊 控制 技术 和 神经 网 络 
控制 技术 。 

(一 ) 模糊 控制 技术 

传统 上 ， 如 果 要 对 机 器 人 实施 高 质量 控制 ， 首 先 要 建立 机 需 人 系统 的 动力 学 模型 。 机 器 
人 的 动力 学 模型 是 一 个 强 耦 合 、 高 度 非 线性 的 关于 关节 变量 的 二 阶 常 微分 方程 组 。 在 机 器 人 
以 慢 速 运行 时 ， 可 将 其 关节 间 的 耦合 作用 视 为 干扰 而 采用 独立 关节 控制 原则 ， 便 可 以 对 各 关 
节 采 用 PID 控制 。 另 外 ， 还 可 以 采用 频 域 分 析 等 现代 控制 理论 的 各 种 控制 思想 ， 实 施 如 逆 动 
力学 方法 前 侍 探 制 、 解 耦 控制 及 反 锯 线性 化 控制 等 。 

这 些 控制 方法 有 一 个 共同 的 特点 ， 即 它们 都 强烈 地 依赖 所 建立 的 数学 模型 ， 在 精确 知道 
系统 模型 时 能 得 到 很 好 的 控制 效果 。 然 而 由 于 实际 应 用 时 机 需 人 的 参数 不 可 能 足够 精确 
( 建 模 过 程 中 进行 了 各 种 假设 、 近 似 处 理 ) ， 或 由 于 存在 一 些 未 建 模 特性 ， 再 加 上 不 可 避免 
地 存在 一 些 干扰 ， 使 得 这 些 方法 不 能 单独 得 到 实际 应 用 ， 因 此 必须 针对 这 些 不 确定 因素 相应 
地 改造 传统 控制 框架 ， 而 这 正 是 智能 控制 要 解决 的 问题 。 

1965 年 ，L. A. Zade 提出 了 模糊 集合 的 概念 ， 从 而 创立 了 模糊 理论 。 模 糊 理论 是 介 于 推 
理 与 计算 之 间 的 一 种 工具 和 方法 。 形 式 上 它 利 用 规则 进行 逻辑 推理 ,但 其 逻辑 取 值 可 以 在 0 
~1 之 间 连 续 变 化 。 其 处 理 方法 也 是 基于 数值 的 方法 而 非 符 号 的 方法 。 符 号 处 理 方法 允许 直 
接 用 规则 表示 结构 性 知识 ,但 是 它 却 不 能 直接 使 用 数值 计算 的 工具 ， 因 而 也 不 能 用 大 规模 集 
成 电路 来 实现 一 个 人 工 智 能 系统 。 而 模糊 系统 可 以 兼 具 两 者 的 优点 ， 它 可 用 数值 的 方法 来 表 
示 结 构 性 知识 ， 从 而 用 数值 的 方法 来 处 理 。 因 而 随 着 计算 机 技术 的 发 展 ， 模 糊 理论 在 控制 领 
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域 取 得 了 巨大 的 成 功 。 

模糊 理论 的 应 用 集中 在 被 控 过 程 没 有 数学 模型 或 很 难 建立 数学 模型 的 工业 过 程 ， 这 些 过 
程 的 参数 具有 时 变性 及 非 线性 等 特征 。 模 糊 控制 技术 不 需要 建立 精确 的 数学 模型 ， 是 解决 不 
确定 性 系统 控制 问题 的 一 种 有 效 途 径 。 

1. 模糊 控制 器 的 工作 原理 

如 图 5-21 所 示 ， 在 模糊 控制 回路 中 ， 模 糊 控制 融 的 一 个 输入 是 被 控 系 统 敏感 环节 输出 
的 测量 量 ， 另 外 一 个 输入 量 是 设 
定 值 输入 ;模糊 控制 右 的 输出 则 
是 被 控 系 统 的 调节 环节 输入 。 

在 常规 控制 中 可 以 使 用 传递 
函数 和 数学 方程 精确 地 描述 控制 
大 的 输入 、 输 出 特性 。 例 如 假设 
有 一 个 目 动 调 温和 系统， 其 常规 控 
制 语句 如 下 : 















模糊 控制 器 


测量 量 
去 模糊 化 模糊 推理 模 类 化 ”上 | 流 定 量 


如 果 室 温 三 27 WC ， 则 启动 


控制 率 、 隶 属 函 数 
制冷 ; 


如 果 室 温 >18 % 有 上 且 <27 % ， 图 5-21 模糊 控制 系统 原理 图 
则 不 启动 调 温 系 统 ; 

如 果 室 温 夺 18 WC ， 则 启动 加 热 。 

但 在 模糊 控制 着 中 ， 则 是 使 用 语言 型 模糊 控制 率 来 描述 模糊 控制 历 的 控制 特性 。 模 糊 控 
制 率 是 将 人 类 对 某 一 过 程 的 推理 和 判断 知识 加 以 提炼 后 形成 的 。 对 同一 个 调 温 系 统 则 有 如 下 
描述 : 

如 有 果 室 温 很 低 ， 室 温 还 在 微量 降低 ， 则 全 力 加 热 ; 

如 采 室 温 适 中 ， 室 温 不 再 变化 ， 则 不 加 热 ; 

如 果 室 温 偏 高 ， 室 温 微量 上 升 ， 则 中 等 降温 ; 

如 果 室 温 偏 高 ， 室 温 不 再 变化 ， 则 微量 降温 ; 

如 果 室 温 较 高 ， 室 温 微 量 上 升 ， 则 中 等 降温 。 

在 上 述 语言 描述 中 ， 都 是 根据 条 件 满足 的 情况 得 出 定性 结论 。 如 采用 7 代表 室温 ，d7 
代表 温度 的 变化 ，du 代表 加 热 的 大 小 ， 再 为 每 个 输入 量 定义 出 相应 的 语言 值 即 模 糊 集 : 

室温 了 = | NB 一 一 很 低 ，ZR 一 一 适中 ，PS 一 一 偏 高 ，PM 一 一 较 高 |} ; 

室温 变化 d7 = | NS 微量 降低 ，ZR 一 一 适中 ，PS 微量 上 升 | ; 

温 控 量 du = | PB 一 一 全 力 加 热 ，ZR 一 一 不 加 热 ，NS 一 一 微量 降温 ，NM 一 一 中 等 降 
温 }。 则 可 将 上 述 语言 描述 改写 为 

IF7=NB AND d7T = NS THEN dv=PB; 

IF 7T=ZR AND d7 =ZR THEN du = ZR.; 

OR IF T=PS AND d7T = PS THEN du = NM,; 

OR IF T=PS AND d7 = ZR THEN du = NS; 

OR IF 7T=PM AND d7T = PS THEN du = NM, 

以 上 描述 称 为 温 控 模糊 控制 率 。 它 是 将 模糊 算 子 OR 及 单一 的 下 -THEN 规则 连接 在 一 起 












































NN Tm A 


的 模糊 控制 规则 。 模 糊 控制 紊 和 素 属 函数 及 推理 方法 一 起 决定 着 模糊 控制 带 的 传递 特性 。 
2. 模糊 控制 器 的 组 成 
模糊 控制 融 的 输入 和 输出 都 是 非 模 糊 量 ， 而 其 内 部 却 建立 在 语言 型 的 模糊 控制 率 上 ， 由 
条 件 满足 的 程度 推出 模糊 输出 的 大 小 。 该 推理 过 程 采用 模糊 理论 ， 称 为 模糊 推理 。 为 了 进行 
模糊 推理 ， 必 须 先 将 非 模糊 量 转 化 为 模糊 量 ， 该 过 程 称 为 模糊 化 。 由 于 模糊 推理 的 输出 是 模 
糊 值 ， 还 必须 将 模糊 输出 转化 为 非 模糊 集 ， 该 过 程 称 为 去 模糊 化 。 模 糊 控制 疮 由 模糊 化 、 模 
糊 推理 和 去 模糊 化 三 部 分 组 成 ， 三 部 分 共同 建立 在 知识 库 上 ， 如 图 5-22 所 示 。 














模糊 推理 去 模糊 化 


输入 输出 





知识 库 
(控制 率 、 素 属 函 数 ) 


图 5-22 模糊 控制 紫 的 组 成 


(二 ) 神经 网 络 控制 技术 

神经 网 络 控制 是 20 世纪 80 年 代 以 来 ， 在 人 工 神经 网 络 研 究 取 得 重大 突破 性 进展 的 基础 
上 ， 发 展 起 来 的 自动 控制 领域 的 前 沿 学 科 之 一 。 它 是 智能 领域 的 一 个 重要 分 文 ， 为 解决 复杂 
的 非 线 性 、 不 确定 、 不 确 知 系统 的 控制 问题 开辟 了 一 条 新 的 途径 。 

人 工 神 经 网 络 是 由 人 工 神 经 元 互 连 组 成 的 网 络 ， 它 是 从 微观 结构 的 功能 上 对 人 脑 的 抽 
象 、 简 化， 是 模拟 人 类 智能 的 一 条 重要 途径 ,反映 了 人 脑 功 能 的 硅 干 基本 特征 ， 如 并 行 信息 
处 理 、 和 学习、 联想、 模式 分 类 、 记 忆 等 。 

1. 人 工 神 经 元 

人 工 神 经 元 是 对 生物 神经 元 的 简化 和 模拟 ， 它 是 神经 网 络 的 基本 单元 ， 其 基本 结构 如 图 
5-23 所 示 。 

人 工 神经 元 是 个 多 输入 、 单 输出 的 非 线 > 
性 元 件 ， 其 输入 、 输 出 关系 为 

fe > ii 一 "| 2 

y;: = fA(1.) , 
寺中 训 (7 全 13 .2033 5 完 ) 是 从 其 他 细 
胞 传 来 的 输入 信号 ; 0; 为 羡 值 ; 网 是 从 细胞 7 
到 细胞 i 的 连接 权 值 ; /为 激发 函数 。 a 

2. 人 工 神 经 网 络 模 型 

人 工 神 经 网 络 模型 是 通过 对 人 脑 的 基本 单元 一 一 神经 元 的 建 模 和 连接 ， 探 索 模 拟人 脑 神 
经 系统 功能 的 模型 ， 并 人 研制 一 种 具有 学 习 、 联 想 、 记 忆 和 模式 识别 等 智能 信息 处 理 功 能 的 人 
工 系 统 。 人 工 神经 网 络 模型 具有 许多 形式 ， 这 里 介绍 两 种 ,一 种 是 最 典型 的 多 层 前 馈 网 络 
一 一 BP 网 络 ， 为 一 种 是 CMAC 模型 。 
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(1) BP 网 络 “BP 网 络 如 图 5-24 所 示 ， 这 是 一 种 全 局 示 近 网 络 。BP 网 络 是 单 向 传播 的 
多 层 前 向 网 络 。 网 络 除 输入 、 输 出 节点 外 ， 有 一 层 或 多 层 的 隐蔽 节点 ， 同 层 节 点 间 没 有 任何 
耦合 。 输 入 信号 从 输入 层 节 点 依次 守 过 各 层 节 点 ， 然 后 传 到 输出 节 点 。 每 一 层 节 点 的 输出 只 
影响 下 一 层 节 点 的 输出 。 每 个 节点 都 有 完整 的 神经 元 结构 。 
































图 5-24 BP 网 络 模型 


BP 网 络 是 1986 年 由 和 鲁 姆 哈 特 (Rumelhart. D. E) 和 麦克 利 兰 (Mcclelland.L) 等 人 提出 
的 多 层 前 馈 网 的 反 癌 传播 算法 。 该 网 络 并 不 依赖 模型 ， 只 需要 有 足够 多 的 隐 层 和 隐 结 点 。 利 
用 BP 网 络 可 以 实现 机 絮 人 手眼 协调 控制 ; 将 BP 网 络 与 异步 自学 习 控 制 算 法 结合 ， 组 成 神 
经 网 络 异 步 上 自学 习 控制 系统 ， 对 机 副 人 进行 轨迹 跟踪 控制 ， 可 以 取得 很 好 的 跟踪 效果 。 

(2) CMAC 神经 网 络 CMAC 神经 网 络 是 仿照 小 脑 控 制 上 肌体 运动 的 原理 而 建立 的 神经 网 
络 模型 ， 称 为 小 脑 关节 控制 模型 (图 5-25 ) 。CMAC 每 个 神经 元 的 输入 输出 是 一 种 线性 关 
系 ， 但 其 总 体 上 可 看 做 一 种 表达 非 线性 映射 的 表格 系统 。 由 于 CMAC 网 络 的 学 习 只 在 线性 
映射 部 分 ， 因 此 可 和 采用 简单 的 6 算法 ， 其 收敛 速度 比 BP 算法 快 得 多 ， 且 不 存在 局 部 极 小 问 

。CMAC 最 初 主要 用 来 求解 机 械 手 的 关节 运动 ， 现 在 已 广泛 应 用 于 机 器 人 的 控制 中 ， 例 如 

Miller 双 . 工 等 人 已 将 其 成 功 地 用 于 机 顺 人 实时 动态 轨迹 跟 踩 的 控制 中 ， 使 PUMA 机 械 手 的 
跟踪 精度 达到 百 分 之 一 的 数量 级 。 

















图 5-25 ”CMAC 网 络 模型 








人 工 神 经 网 络 通过 许多 简单 的 关系 来 实现 复杂 的 函数 关系 ， 这 些 简单 的 关系 有 些 是 非 0 
即 1 的 简单 逻辑 关系 ， 通 过 这 些 简单 关系 的 组 合 可 实现 复杂 的 分 类 和 决策 功能 。 由 于 神经 网 
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络 在 许多 方面 试图 模拟 人 脑 的 功能 ， 因 此 神经 网 络 控 制 并 不 依赖 精确 的 数学 模型 ， 并 且 神 经 
网 络 对 信息 的 并 行 处 理 能 力 和 快速 性 ， 适 于 机 一 人 的 实时 控制 ， 神 经 网 络 本 质 上 的 非 线 性 特 
性 为 机 器 人 的 非 线性 控制 带 来 了 和 希望， 神经 网 络 可 通过 训练 获得 学 习 能 力 ， 能 够 解决 那些 用 
数学 模型 或 规则 描述 难以 处 理 或 无 法 处 理 的 控制 过 程 。 机 豆 人 神经 网 络 控制 还 主要 应 用 在 机 
信人 路 径 规 划 和 运动 控制 方面 。 

3. 神经 网 络 控 制 方法 

神经 网 络 控 制 方法 随 着 控制 紫 结 构 的 不 同 而 不 同 ， 这 里 介绍 几 种 典型 控制 紫 结 构 及 神经 
网 络 控 制 方法 。 

(1) 神经 网 络 监 督 控制 ”如 果 被 控 对 象 的 解析 模型 未 知 或 部 分 未 知 时 ， 用 传统 的 控制 
理论 设计 控制 带 将 会 非常 困难 。 此 时 可 通过 对 人 工 或 传统 控制 奋进 行 学 习 ， 然 后 用 神经 网 络 
控制 部 取代 或 逐步 取代 原 控制 锅 ， 这 种 方法 称 为 神经 网 络 监 督 控制 〈 图 5-26 ) 。 

















图 5-26 神经 网 络 监 督 控制 





这 种 控制 方法 就 是 在 传统 控制 融 的 基础 上 再 增加 一 个 神经 网 络 控制 顶 ， 如 图 5-26 所 示 。 
此 时 ， 神 经 网 络 控制 硕 通 过 学 习 传 统 控制 融 的 输出 在 线 调整 上 自己， 目标 反馈 误差 e (1) 或 
ul 《〈 巧 趋 近 于 零 ， 神 经 网 络 控制 硕 逐 渐 在 控制 作用 中 占据 主导 地 位 ， 从 而 最 终 取消 反馈 控制 
胡 的 作用 。 但 是 ,一 旦 系统 出 现 干扰 ， 反 馈 控 制 带 仍然 可 以 重新 作用 。 因 此 ， 采 用 这 种 前 馈 
加 反馈 的 监督 控制 方法 不 仅 可 确保 控制 系统 的 稳定 性 和 和 鲁 棒 性 ， 而 且 可 有 效 地 提高 系统 的 精 
度 和 目 适 应 能 

(2) 神经 网 络 直接 逆 控 制 ”神经 网 络 直 接 逆 控 制 就 是 将 被 控 对 象 的 神经 逆 模 型 直接 与 
被 控 对 象 串 联 起 来 ， 使 期 望 输出 《〈 即 网 络 输入 ) 与 对 象 实际 输出 之 间 的 传递 函数 等 于 1， 从 
而 在 将 此 网 络 作为 前 馈 控制 此 后 使 被 控 对 象 的 输出 为 期 望 输出 。 

神经 网 络 直接 逆 控制 的 可 用 性 很 大 程度 上 取决 于 逆 模 型 的 准确 程度 。 由 于 缺少 反 饿 ， 简 
单 连接 的 直接 逆 控 制 鲁 棒 性 不 强 。 因 此 ， 在 实际 使 用 中 ， 该 模型 的 连接 权 值 必须 能 够 在 线 修 
正 。 
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工业 机 右 人 能 够 按照 自动 化 生产 线 工 位 的 工艺 要 求 沿 着 指定 路 径 运 动 ， 是 由 于 工业 机 融 
人 的 程序 控制 。 当 前 实用 的 工业 机 各 人 编程 方法 主要 为 离线 编程 和 示 教 编程 。 采 用 示 教 编程 
可 以 在 调试 阶段 通过 示 教 控制 硕 对 机 需 人 系统 的 运行 轨迹 进行 编程 ， 对 编译 好 的 程序 一 步 一 
步 地 执行 ， 调 试 成 功 后 可 投入 正式 运行 。 擎 握 示 教 编程 大 编 程 方式 是 使 用 、 维 修 机 秀 人 系统 
所 必需 的 。 

目前 ， 相 当 数 量 的 机 各 人 仍 采 用 示 教 编程 方式 。 机 带 人 示 教 后 可 以 立即 应 用 ， 在 再 现 
时 ,机 各 人 重复 示 教 时 存 入 存储 如 的 轨迹 和 各 种 操作 ， 如 果 需 要， 过 程 可 以 重复 多 次 。 

优点 : 简单 方便 ; 不 需要 环境 模型 ; 对 实际 的 机 各 人 进行 示 教 时 ， 可 以 修正 机 械 结构 种 
来 的 误差 。 

缺点 : 功能 编辑 比较 困难 ， 难 以 使 用 传 感 希 ， 难 以 表现 条 件 分 文 ， 对 实际 的 机 大 人 进行 
示 教 时 ， 有 要 据 用 机 化 人 。 


第 一 盖 _MOTOMAN 弧 焊 机 费 人 纺 程 


弧 焊 机 帮 人 工作 站 系统 采用 日 本 安 川 (YASNAC) 公司 MOTOMAN-UP20 型 机 絮 人 ， 控 
制 柜 采 用 YASNAC XRC UP20 型 ， 焊 接 电源 采用 MOTOWELD-S350 型 一 体 化 弧 烛 电源。 辅助 
系统 包括 送 丝 机 构 、 保 护 气 瓶 等 。 该 机 器 人 可 实现 汽车 排 气管 道 消声器 的 弧 焊 焊接 工艺 。 











一 、MOTOMAN 机 器 人 系统 


(一 ) MOTOMAN 机 器 人 控制 系统 

机 从 人 控制 系统 是 机 货 人 的 主要 组 成 部 分 ， 相 当 于 机 共 人 的 大 脑 ， 用 来 处 理 机 仑 人 接收 
的 信息 ， 同 时 发 送 处 理 结果 信息 给 机 希 人 及 其 外 围 设 备 。 图 6-1 所 示 为 MOTOMAN 机 天 人 的 
控制 系统 。 机 右 人 本 体 、 传 感 系统 、 示 教 编 程 融 等 系统 都 与 控制 系统 接 入 。 

主 电源 开关 用 来 开启 或 关闭 机 器 人 系统 。 再 现 操 作 盒 用 来 调试 机 器 人 程序 自动 运行 的 操 
作 面 板 。 按 钮 详细 信息 如 图 6-2 所 示 。 

(二 ) MOTOMAN 机 器 人 示 教 编程 器 

利用 示 教 编程 带 可 以 实现 机 化 人 的 上 电 和 下 电 ;， 通过 示 教 编程 途上 的 控制 键 可 以 实现 机 
俩 人 的 各 个 关 市 沿 着 不 同 的 坐标 运动 。 例 如 ， 可 以 用 示 教 编程 絮 来 控制 机 副 人 的 六 个 轴 关 市 
分 别 转动 一 个 任意 角度 。 除 此 之 外 示 教 编程 锅 还 可 以 实现 用 户 的 其 他 一 些 高 级 操作 ， 如 程序 
的 编写 、 文 件 的 人 存储、 运行 速度 的 调节 、 机 天 人 运行 状态 的 观察 以 及 其 他 一 些 高 级 选项 的 设 
置 等 。 可 以 说 示 教 编程 硕 就 是 一 人 台 小 型 的 PC 机 ， 用 它 可 以 实现 简单 的 机 需 人 操作 和 控制 。 
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示 教 编程 器 





图 6-1 MOTOMAN 机 大 人 的 控制 系统 


报警 按钮 
(发 生 报警 错误 时 知 亮 ) 


( 接 通 伺服 电源 时 使 用 ) 


( 再 现 模式 / 示 教 模 
式 切 换 时 使 用 ) 


启动 按钮 
(开始 再 现时 使 用 ) 


(允许 /禁止 编辑 
切换 时 使 用 ) 


暂停 按钮 
( 再 现 暂 停 时 使 用 ) 





图 6-2 再 现 操 作 面 板 








机 各 人 示 教 编程 主要 采用 示 教 编程 侨 编 写 程序 ， 每 个 厂家 的 机 右 人 配置 不 同 的 示 教 编程 紫 。 
图 6-3 所 示 为 MOTOMAN 机 副 人 示 教 编程 融 。 使 用 示 教 编程 融 的 轴 操 作 键 可 以 使 机 何人 的 各 
个 关节 运动 ， 也 可 以 在 相应 的 坐标 系 下 进行 直线 运动 或 绕 轴 旋转 改变 姿态 。 





二 、MOTOMAN 机 器 人 系统 运行 


机 和 絮 人 系统 正常 启动 后 ， 使 用 示 教 编程 器 按照 工艺 要 求 进 行 示 教 编程 。 

(一 ) 机 器 人 系统 的 启动 操作 

1. 启动 系统 

打开 机 器 人 控制 柜 的 电源 开关 ， 把 控制 柜 系 统 正面 主 电源 开关 旋 至 “ON” 位 ， 接 通 主 
电源 ， 控 制 柜 系统 内 部 进行 初始 化 诊断 后 ， 等 待机 器 人 数秒 钟 的 自 检 时 间 ， 在 示 教 编程 右上 


菜单 区 域 






通用 显示 区 域 -十 - 


| wmwwzi000 ”| “| - 翻 页 刍 
| |> 关节 速度 = 


好 六 


开关 
(在 内 测 ， 握 住 时 ， 
伺服 电源 接 通 ) 





数值 键 /专用 键 
(输入 数值 时 按 数值 键 。 

这 些 数值 键 还 是 输入 命令 等 功能 便利 

的 专用 键 , 作为 专用 键 使 用 的 时 候 ， 可 自动 切换 ) 


图 6-3 MOTOMAN 机 顺 人 示 教 编程 器 





插 补 方式 键 


显示 初始 画面 

2. 选择 示 教 模式 

在 控制 柜 面 板 选 择 示 教 模式 : 按 下 “TEACH” 键 ,“TEACH” 键 灯 点 亮 。 

3. 伺服 上 电 

选择 好 示 教 模式 后 ， 应 按 控制 柜 面 板 “SERVO ON READY” 键 ， 这 个 键 灯 闪 。 

4. 示 教 锁定 

拿 起 示 教 编程 器 ， 按 下 示 教 编程 器 上 的 “ 示 教 锁定 ”按钮 。 

5. 接 通 伺服 电源 

如 图 64 所 示 ， 左 手 握 住 示 教 编程 需 左 后 方 的 安全 开关 ， 接 通 伺服 电源 ， 示 教 编程 髓 僻 
服 电 源 灯 亮 。 示 教 编程 器 上 电 的 手 握 位 置 有 三 个 : 第 一 个 位 置 为 静止 状态 ; 第 二 个 位 置 为 上 
电位 置 ; a 转 为 断 电 状态 。 
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握 住 ON 用 力 握 OFF 
图 6-4 示 教 编程 器 上 电 





(二 ) 示 教 机 器 人 动 起 来 

1. 设 定 运动 速度 

按 示 教 编程 右 中 部 的 “手动 速度 ” 键 ， 使 机 吉 人 的 动作 速度 减低 ， 如 图 6-5a 中 圆圈 所 
示 ， 在 显示 屏 上 右上 角 有 一 个 像 台 阶 似 的 标志 表示 速度 ， 底 层 表示 速度 低 。 手 动 速度 的 选择 
使 用 如 图 6-5b 所 示 。 




















a) b) 


图 6-5 速度 选择 及 显示 
a) 速度 屏幕 显示 b) 手动 速度 键 

2. 选择 关节 坐标 系 

机 器 人 主要 以 关节 坐标 系 和 直角 坐标 系 工作 ， 按 下 示 教 编程 器 的 轴 操 作 键 ， 机 器 人 各 轴 
即 可 运动 。 按 示 教 编程 器 上 部 的 “坐标 ” 键 ， 每 按 下 一 次 “坐标 ” 键 ， 坐 标 在 关节 坐标 系 
和 直角 坐标 系 、 工 具 坐标 系 、 用 户 坐 标 系 之 间 变换 一 次 。 按 “坐标 ” 键 ， 选 择 关 节 坐 标 系 ， 
机 器 人 以 单个 关节 运动 的 方式 运动 。 

如 图 6-5a 中 所 示 ， 在 显示 屏 速度 标志 的 左边 出 现 - 鱼 标 志 时 ， 表 示 为 关节 坐标 系 。 


3. 操作 “ 轴 操 作 ” 键 国 
各 图 66 所 示 ， 在 示 教 编 得 和 的 上 于 部 分 有 12 个 
“ 轴 操 作 ” 键 ， 分 为 六 组 ， 每 组 控制 一 个 轴 的 动作 ， 用 这 5 5 
12 个 键 ， 就 可 以 让 机 器 人 动 起 来 。 > > 
在 关节 坐标 系 下 ， 看 “ 轴 操 作 ” 键 上 的 下 档 文字 ， 参 
照 表 6-1 中 的 关节 坐标 系 的 “ 轴 操 作 ” 键 和 机 器 人 轴 动 作 
的 对 应 关系 ， 按 住 “ 轴 操作 ” 键 ， 机 器 人 对 应 的 轴 就 开始 铀 操作 刍 
动作 ， 使 机 器 人 运动 到 想 要 的 位 置 ， 松 开 ， 机 器 人 停止 运 ” 图 6-6 示 教 器 “ 轴 操 作 ” 刍 
动 。 
4. 选择 直角 坐标 系 
按 示 教 编程 器 上 部 的 “坐标 ” 键 ， 切 换 到 直角 坐标 系 。 在 显示 屏 上 出 现 图 6-7 圆圈 所 示 
的 标志 ， 表 示 为 直角 坐标 系 ， 图 6-8 所 示 为 直角 坐标 系 的 机 器 人 运动 方向 。 
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表 6-1 机 器 人 关节 坐标 系 的 轴 操 作 
轴 名 称 操 作 键 动 作 


5 轴 本 体 左右 转动 








基本 轴 工 轴 全 人 下 臂 前 后 摆动 








U 轴 人 上 臂 上 下 摆动 
胸部 轴 8 轴 手腕 上 下 运动 

















7 了 轴 人 和合 手指 转动 





图 6-7 ”直角 坐标 系 屏 幕 显示 图 6-8 直角 坐标 系 的 机 器 人 运动 方向 





机 带 人 在 直角 坐标 系 下 的 运动 ( 沿 各 坐标 轴 的 平 动 和 绕 各 个 轴 的 旋转 运动 ) 如 图 6-9 所 
未 。 图 的 上 半 部 分 为 机 各 人 和 平行 汽 轴 移动 ， 图 的 下 半 部 分 为 机 如 人 沿 轴 转动 。 

在 直角 坐标 系 下 ， 机 各 人 运动 时 不 止 一 个 关 市 动作 ， 这 样 才能 使 机 右 人 做 直线 运动 ， 这 
时 “ 轴 操 作 ” 键 为 上 档 键 的 意义 。 


三 、MOTOMAN 机 器 人 示 教 编程 


机 郁 人 系统 的 具体 工作 是 通过 示 教 编程 带 编 程 来 实现 的 。 在 示 教 机 天 人 时 ， 需 要 教 它 做 
一 些 动作 。 如 果 让 它 记 住 这 些 动作 ， 吏 要 把 这 些 动作 按照 先后 顺序 记录 下 来 ， 记 录 的 过 程 驶 
是 编辑 程序 的 过 程 。 程 序 编 好 之 后 ， 可 以 让 机 大 人 再 现 这 些 动作 ， 它 就 会 按照 程序 从 头 到 尾 
再 做 一 过 示 教 给 它 的 动作 。 编 程 操 作 顺 序 如 下 : 


NN Tm A 


Wal 沿 Z 轴 平行 移动 















SS ) 


ee 
U 


























图 6-9 机 融 人 在 直角 坐标 系 下 的 运动 示意 图 
(一 ) 建立 新 程序 
1) 如 图 6-10a 所 示 的 示 教 名 的 主 沫 单 界面 中 ， 用 光标 键 移动 光标 至 < 程序 > 选项 ， 按 
“选择 ” 键 确定 ， 进 入 到 图 6-10b 所 示 程 序 的 子 荣 单 界面 ， 在 子 菜单 中 用 光标 键 移 动 光标 到 








四 -名 


图 6-10 “ 示 教 器 的 荣 单 界面 
a) 主 菜 单 界面 b) 子 菜单 界面 
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< 新 建 程序 > 选项 ， 按 “选择 ” 键 确 定 。 

2) 建立 新 程序 的 界面 如 图 6-11a 所 示 ， 单 击 “ 程 序 名 ”后 的 光标 指示 区 域 ， 进 入 图 6- 
11b 学 母 表 界面 ， 进 行程 序 名 称 输入 。 按 “选择 ” 键 , 再 按 图 6-1le 所 示 的 “ 翻 页 ” 键 ， 进 
行 字 母 的 选择 。 





NOPQRSTUVWXYZ 
0123456789+ -= 


| "#%& (),，. = 


| 执行] [到 为 ] 





图 6-11 新 程序 建立 界面 
a) 建立 新 程序 界面 b) 字母 表 界面 “) 翻 页 按键 














3) 输入 文件 名 。 显 示 字 母 表 后 ,移动 光标 到 所 选 的 文件 名 字母 处 ， 按 “选择 ” 键 ， 即 
可 输入 文件 名 中 的 首 字 母 ， 再 移动 光标 到 文件 名 字母 其 他 字母 处 ， 按 “选择 ” 键 ， 到 文件 
名 字母 全 部 输入 完成 (文件 名 不 超过 8 个 字符 ， 字 符 可 以 为 英文 、 数 字 、 个 别 符号 ) 。 例 
如 ， 图 6-12 所 示 文 件 名 为 “TEST”,， 按 “ 回 车 ” 键 ， 程 序 名 被 输入 。 输 入 错误 时 ， 按 “ 清 
除 ” 键 清除 。 程 序 名 称 可 使 用 数字 、 英 文字 母 及 其 他 符号 ， 最 大 长 度 为 8 个 字符 。 

4) 进入 编程 界面 。 移 动 光 标 到 图 6-12 显示 的 “执行 ”选项 ， 按 “选择 ” 键 ， 显示 编 
程 界面 。 至 此 ， 建 立新 程序 的 工作 完成 ， 进 入 编程 状态 ， 如 图 6-13 所 示 。 
































=> MOVJ VJ =0.78 


图 6-12 ”编辑 文件 名 界面 图 6-13 程序 编辑 界面 


(二 ) 输入 程序 

1) 让 机 和 恬 人 在 关节 坐标 系 下 ， 移 动 到 左边 的 第 一 个 位 置 点 1。 光 标 在 行 号 0000 处 时 ， 
按 “ 选 择 ” 键 。 

2) 设 定 再 现 速度 。 问 右 移动 光标 到 MOVJ 指令 上 ， 按 “选择 ” 键 ， 再 向 右 移动 光标 到 
速度 “VJ =” 上 ，, 按 “选择 ” 键 ， 在 屏幕 最 后 一 行 显示 “关节 速度 =”， 用 “数字 ” 刍 输 
人 12, 显示 的 数值 为 最 大 速度 的 -一 一 一 
12% ， 如 图 6-14 所 示 。 => MOVJ VJ-R 

按 “ 回 车 ” 键 确 认 。 至 此 ， 机 图 6-14 关节 速度 输入 界面 
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船 人 的 位 置 1 就 被 记录 了 。 程序 的 第 一 行 也 输入 完毕 ， 如 图 6-15 所 示 。 
3) 操作 “ 轴 操 作 ” 键 ， 使 机 天 人 运动 到 位 置 点 2， 按 “ 回 车 ” 键 确 认 ， 如 图 6-16 所 示 。 





NC 0000 NOP 
0000 NOP 0001 MOVJ VJ = 12.00 
MOVJ VJ = 12.00 | MOVJ VJ = 12.00 
0002END _  _  __._._ ._. 0003 END ee 


图 6-15 第 一 行程 序 行 信息 图 6-16 第 二 行程 序 行 信息 


4) 同样 按 步骤 3) 的 方法 使 机 天 人 运动 到 位 置 点 3、 位 置 点 4， 生 成 程序 如 图 6-17 所 














示 ， 机 需 人 的 运动 轨迹 如 图 6-18 所 示 。 至 此 程序 编辑 完 
人 or 初始 位 置 点 
0000 NOP 
O00 MOV YJ = 12.00 
0002 NOW VY = 12.00 
0003 MOVY VJ = 12.00 位 置 点 1 
[Rl MOVYJ VJ =12.00 
0005 END -| 
AN 本 
人 于 点 3 
图 6-17 程序 信息 图 6-18 ”机 器 人 运动 轨迹 
(三 ) 轨迹 确认 
在 完成 了 程序 输入 之 后 ， 应 检查 各 个 位 置 点 是 。 即 让 机 器 人 按照 设 定 的 位 置 分 步 
走 一 遍 ， 看 看 各 个 位 置 点 是 否 合适 。 [ 舍 ` 
调试 机 大 人 程序 运行 过 程 的 具体 操作 步骤 如 下 : 玫 仿 这 度 


1) 把 光标 移 到 位 置 点 1 所 在 行 0001。 

2) 如 图 6-19 所 示 ， 按 “手动 速度 ” 键 ， 设 定 速度 为 ， 

3) 按 下 “前 进 ” 键 ， 机 器 人 会 走 到 位 置 点 1， 再 按 “ 前 进 ” 键 ， 机 器 FE 
全 本 

4) 程序 点 确认 完成 后 ， 光 标 回 到 程序 起 始 处 。 ER 

(四 ) 试 运行 确认 操作 刍 

程序 编辑 完成 后 ， 要 试 着 让 机 器 人 自己 做 一 遍 播 头 动作 ， 这 就 是 试 运行 。 

1) 光标 回 到 程序 起 始 行 0000 处 。 

2) 如 图 6-20 所 示 ， 按 下 “连锁 ” 键 的 同时 ， 按 下 “ 试 运行 ” 键 ， 机 器 人 连续 运行 所 
有 程序 点 ， 一 个 循环 后 停止 。 

(五 ) 再 现 操作 

机 器 人 编辑 的 程序 试 运行 没 问题 后 ， 就 可 以 进行 再 现 操作 了 。 
再 现 操 作 之 前 首先 要 做 的 是 : 

1. 解除 示 教 锁定 

按 编程 器 上 的 “ 示 教 锁定 ” 键 ， 该 键 灯 灭 。 




















图 6-20 “连锁 ”+ 
“ 试 运行 ”操作 键 
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2. 安全 确认 

机 器 人 周围 没 人 ， 提 醒 人 们 注意 安全 。 

然后 进行 再 现 操作 ， 机 器 人 开始 自动 运行 程序 。 操 作 按 钮 如 图 6-21 所 示 ， 操 作 步 又 如 下 : 

1) 切换 到 再 现 模式 。 按 控制 面板 上 的 ra 0 。 
“PLAY” 键 ; “PLAY” 灯 亮 。“SERVO ON 四] 
READY” 电 源 灯 灭 。 

2) 伺服 上 电 。 按 “SERVO ON READY” 图 621 再 现 操作 按键 
键 ， 这 个 键 灯 亮 。 

3) 开始 再 现 运 行 。 按 控制 面板 上 的 “START” 按 钮 ， “START” 灯 亮 ， 机 需 人 按照 示 
教 的 动作 运行 一 过 后 停止 。 








四 、MOTOMAN 机 器 人 的 常用 示 教 编程 指令 


为 了 使 机 各 人 能 够 进行 再 现 运 动 ， 就 必须 把 机 需 人 运动 命令 编 成 程序 。 控 制 机 辞 人 运动 
的 命令 就 是 移动 命令 。 在 移动 命令 中 记录 有 移动 到 的 位 置 、 择 补 方式 、 再 现 速度 等 。 因 为 
MOTOMAN 机 大 人 系统 使 用 INFORM 开 语 言 进行 编程 ， 其 主要 的 移动 命令 都 以 “MOV ”来 
开始 ， 所 以 也 把 移动 命令 称 为 “MOV ”命令 。 

机 船 人 再 现 运 动 时 ， 决 定 程 序 点 间 采 取 何 种 轨迹 移动 的 方式 称 为 插 补 方式 。 篆 用 的 搬 补 
方式 有 : 关 市 插 补 方式 、 直 线 搬 补 方式 、 圆 弧 插 补 方式 、 自 由 曲线 插 补 方式 。 

(一 ) 关节 插 补 方式 

关节 插 补 方式 只 有 起 点 和 终点 的 位 姿 要 求 ， 中 间 路 径 以 任意 轨迹 移动 ， 没 有 路 径 约 束 ， 
关节 具有 最 大 的 速度 和 加 速度 ， 速 度 连续 ， 各 轴 协 调 。 移 动 指令 为 MOVJ。 

(二 ) 直线 插 补 方式 

直线 插 补 方式 以 直线 轨迹 移动 。 机 侣 人 在 移动 过 程 中 ， 上 自动 改变 手腕 的 位 置 。 移 动 指令 
为 MOVL。 

示 教 编程 天 的 操作 为 : 按 示 教 编程 右上 部 的 “坐标 ” 键 ， 切 换 到 直角 坐标 系 ; 按 “ 插 补 
方式 ” 键 ， 把 插 补 方式 定 为 直线 插 补 方式 ， 在 输入 显示 行 中 ， 以 MOVL 表示 直线 插 补 方式 。 

设 定 直 线 插 补 方式 的 再 现 速 度 : 光标 在 显示 速度 “V=” 上 ， 按 “转换 ” 键 的 同时 按 
光标 键 ， 加 上 为 加 速 ， 辐 下 为 减速 ， 速 度 单 位 为 cm/min， 可 以 修改 直线 插 补 方式 的 运动 速 
度 的 大 小 。 

(三 ) 圆 孤 差 补 方式 

圆 弧 差 补 方式 使 机 需 人 沿 着 用 圆 弧 差 补 示 教 的 三 个 程序 点 ， 执 行 圆 驳 轨迹 移动 。 移 动 命 
































令 为 MOVC。 如 图 6-22a 所 示 ， 国 、 国 、 图 三 个 点 ， ® 
用 MOVC 插 补 方式 编程 。 

示 教 编程 器 的 操作 为 : 按 示 教 编程 器 上 部 的 ® 同人 
“坐标 ” 键 ， 切 换 到 直角 坐标 系 ， 按 “ 插 补 方式 ”上 ® 
键 ， 把 插 补 方式 定 为 圆 弧 插 补 方式 ， 在 输入 显示 行 ， p) 

中 ， 以 MOVC 表示 圆 弧 插 补 方式 。 ss 


图 6-22a 曲线 程序 为 : a) 圆 弧 b) 自由 曲线 
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MOVJ VJ=50.00; 关节 插 补 指令 (点 ) 
MOVL V=66; 直线 插 补 指令 〈 人 @ 点 ) 
MOVC YV =66; 圆 弧 插 补 指令 〈 人 点 ) 
MOVC YV =66; 圆 弧 插 补 指令 〈 人 由 点 ) 


(四 ) 自由 曲线 差 补 方式 

自由 曲线 差 补 方式 是 机 器 人 沿 着 不 规则 曲线 移动 时 的 一 种 示 教 命令 ， 由 三 个 点 形成 一 个 
抛物 线 曲 线 。 自 由 曲线 插 补 指令 为 MOVS。 如 图 6-22b 所 示 、 国 、@ 三 个 点 ， 用 MOVS 插 
补 方式 编程 。 

(五 ) 延 时 等 待 指令 

机 器 人 在 高 速 运动 过 程 中 , 在 达到 工作 位 置 和 离开 工作 位 置 时 , 机械 结构 并 没有 完全 稳定 ， 
需要 停顿 一 段 时 间 , 等 机 械 结构 完全 稳定 后 再 进行 下 一 个 动作 。 因 此 常 在 该 位 置 使 用 延 时 等 竺 
指令 , 使 机 器 人 在 此 位 置 上 静止 几 秒 钟 。 延 时 等 待 同时 也 可 保证 机 器 人 与 外 界 通信 信息 正常 接 
收 与 发 送 , 消除 机 器 人 系统 的 惯性 力 带 来 的 冲击 ,保证 机 器 人 系统 工作 过 程 的 工艺 性 要 求 。 

MOTOMAN 机 器 人 的 延 时 等 待 指令 为 TIMER。TIMER 命令 就 是 使 机 器 人 在 设 定 的 时 间 
内 停止 动作 的 定时 命令 。 例 如 “TIMER T=4” 命 令 规定 动作 停止 的 时 间 为 4s。 

(六 ) 子 程序 调用 指令 、 跳 转 指令 

在 一 般 情况 下 ， 需 要 多 次 执行 的 程序 ， 可 以 单独 编辑 ， 在 需要 执行 时 ， 调 用 该 程序 。 调 
用 指令 在 机 器 人 编程 中 应 用 较为 广泛 。 如 CALL AB (调用 名 称 为 AB 的 子 程序 ) 。 

机 器 人 实际 编程 过 程 通常 要 求 机 器 人 重复 进行 某 些 操作 时 ， 可 用 跳 转 指令 来 控制 程序 特 
环 执行 。 跳 转 指令 用 JUMP LABEL 表示 ， 其 中 JUMP 表示 跳 转 ，LABEL 是 跳 转 标志 符 。 

机 器 人 执行 JUMP、CALL 指令 ， 要 求 机 器 人 在 运行 中 ， 某 些 程序 指令 重复 执行 时 ， 使 
用 JUMP、CALL 指令 ， 可 以 使 得 程序 简单 ， 提 高 编程 效率 。 

JUMP: 跳 转 到 指定 标号 或 程序 ; 

CALL: 调 出 所 指定 的 程序 ; 


五 、 机 器 人 弧 焊 消声器 


首钢 更 托 曼 机 如 人 有 限 公司 依托 日 本 安 川 电机 MOTOMAN 弧 焊 专用 机 需 人 的 撤 术 优势 ， 
与 全 球 两 大 排 气 系统 供应 商 FAURECIA 和 TENNECO 紧密 协作 ， 不 断 以 最 新 技术 推出 优质 的 
排 气 零 部 件 机 郝 人 弧 焊 线 和 焊接 装备 ， 使 其 具有 技术 领 抑 、 系 统 安全 可 笔 和 快 换 性 能 强 的 特 
点 。MOTOMAN-UP6 机 人 右 人 经 常用 在 弧 焊 焊接 系统 中 ， 下 面 以 机 带 人 焊接 吉普 车 消 声 融 为 
例 ， 介绍 MOTOMAN 机 右 人 弧 焊 焊接 的 编程 指令 。 

机 大人 执行 弧 焊 焊接 工作 ， 除 了 需要 按照 工艺 完成 路 径 轨 迹 的 运动 之 外 ， 还 需要 在 焊接 
过 程 中 使 用 指令 与 外 界 进 行 通信 ， 即 开局 焊接 系统 ， 使 焊接 系统 执行 起 弧 操 作 ， 以 后 的 机 天 
人 在 运行 过 程 中 沿 轨 迹 进行 焊接 ， 焊 接 完 成 后 需要 在 指定 位 置 结束 焊接 ， 准 时 进行 熄 弧 操 
作 。 因 此 ， 弧 焊 机 做 人 除 需要 配备 相应 的 焊接 设备 外 ， 还 需要 对 其 焊接 文件 进行 设 定 ， 焊 接 
参数 设 定 可 以 通过 示 教 编程 句 进 行 设 定 ， 也 可 以 在 指令 后 面 直接 写 人 。 

MOTOMAN 机 大 人 焊接 指令 有 ARCON (起 弧 )、ARCOFF ( 烛 弧 )。 要 求 机 各 人 在 运行 
时 ， 达 到 指定 位 置 时 ， 起 弧 焊 接 ; 完成 相应 的 焊接 任务 后 ， 准 时 烽 弧 。 参 考 程 序 如 下 : 



























































NOP; 
MOVJ VJ=25.0; 
MOVJ VJ=25.0; 
MOVL V =33.0; 


TIMER T=12.50; 


ARCON; 


ee eee 


ARCOFF ; 


TIMER T=12.50; 


MOVL V=33.0; 
MOVJ VJj=25.0; 
END:; 


空 程序 行 ， 程 序 起 始 行 
移动 到 系统 待机 位 置 

移动 到 焊接 开始 位 置 附近 

以 直线 择 补 方式 移动 到 焊接 开始 位 置 

在 12.5s 时 间 内 暂停 运行 

起 弧 ， 焊 接 开始 

焊接 过 程 的 路 径 运 动 ， 移 动 到 焊接 结束 位 置 
烛 弧 ， 焊 接 结 束 

在 12. 5s 时 间 内 暂停 运行 

以 直线 插 补 方式 移动 到 不 碰 触 工件 和 夹具 的 位 置 
移动 到 竺 机 位 置 

程序 结 





机 各 人 焊接 开始 时 需要 注意 以 下 儿 操 : 

1) 调试 好 程序 轨迹 后 ， 再 进行 焊接 硬件 连接 。 

2) 打开 焊接 电源 开关 ， 打 开 气 源 开 关 ， 并 调节 流量 ， 开 始 焊接 。 

3) 注意 防止 资 伤 。 

4) 机 器 人 运行 时 ， 要 随时 注意 起 弧 、 熄 弧 时 的 异常 情况 发 生 ， 随 时 注意 使 用 “紧急 停 
止 ” 键 。 





第 一 节 KUKA 点 焊 机 费 人 编程 


一 、KUKA 机 器 人 系统 


(一 ) KUKA 机 器 人 控制 系统 
图 6-23 所 示 为 KUKA 机 各 人 的 控制 柜 。KR C2 控制 系统 适用 的 机 带 人 类 型 如 图 6-24 所 
示 。KR C2 控制 柜 采 用 熟悉 的 个 人 电脑 Windows 操作 界面 ， 中 英文 多 种 语言 菜单 ; 标准 的 工 
业 计算 机 、 硬 盘 、 光 驱 、 软 驱 、 打 印 机 接口 、ZO 信号 、 多 种 总 线 接口 ， 远 程 诊断 ; 控制 系 
统 具 有 绝对 位 置 记忆 、 软 PLC (选项 ) 功能 ; 事故 间隔 时 间 长 达 7 万 h。 


ss 












:= 


KR 100 comp 

”KR 125 (L90,L100) -2 -3 -4 
KR 140 (L100,L120) comp 
KR 150 (L120,L150) -2 -3 -4 


KR 200 (L120,L150) -2-3-4 
KR 200 (L140,L170) comp 





图 623 KUKA 机 器 人 的 控制 柜 图 6-24 ”KR C2 控制 系统 适用 的 机 器 人 类 型 


mn 


(二 ) KUKA 示 教 编程 器 


如 图 6-25 所 示 ，KUKA 机 器 人 的 示 教 编程 器 采用 按键 方式 ， 实 现 人 机 交互 信息 的 传递 
模式 选择 开关 












伺服 开启 
ESC 键 
窗口 切换 键 


咎 停 
程序 正 向 运行 (启动 ) 
















































































程序 逆向 运行 
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确认 键 
ESC 键 ”菜单 键 ASCT 字母 健 方向 键 


图 6-25 KUKA 机 器 人 示 教 编程 器 
二 、KUKA 机 器 人 系统 运行 


(一 ) 机 器 人 系统 的 启动 操作 
1) 打开 机 需 人 控制 柜上 的 电源 开关 ， 等 竺 系统 局 动 到 图 6-26 所 示 界 面 时 ， 系 统 正 党 局 
动 完 成 。 示 教 需 的 状态 栏 信 息 显 示 如 图 6-27 所 示 。 


区 性 编辑 配置 显示 准备 运行 jE 工区 帮助 


KUKA-KR16 (KRC:Y E: E'S 10 
可 | sr 3 a | 攻 
RMada 所 I 


-本 Program 
-9 System 





21:55:40 200 SS 驱动 部 分 尚未 就 绪 


nls im A 
在 此 帮助 确认 全 部 确认 


图 6-26 机 器 人 正常 启动 后 示 教 副 显 示 信 息 


ET | POV-100z |R_Name | 1 二 配 
J 一 一 9% 通过 (键盘 的 ) 数字 区 可 以 输入 数字 

I 
网 量 | 一 > 数字 区 的 光标 控制 功能 处 于 激活 状态 


[nuw [ms 国 国 | | | Er [POV-100% |R_Mame | 1345 
jiNs ”一 3 括 入 模式 处 于 激活 状态 ( 现 有 的 文字 在 文字 输入 时 向 右 移 ) 

| 

中 一 一， 改写 模式 处 于 激活 状态 ( 现 有 的 文字 被 改写 ) 


iins Tn [Persone|i265 
圆 一 一 *? 绿色 : “提交” 解 科 程序 正在 运行 
Ss 一 一 了 红色 :“ 提 交 ” 解 释 程 序 停 下 


图 6-27 示 教 带 状 态 栏 信息 


2) 选择 动作 模式 。KUKA 机 做人 党 用 动作 模式 有 四 种 : 手动 慢 速 TI、 手动 快速 了、 内 
部 上 自动、 外 部 自动 。 

如 图 6-28 所 示 ， 使 用 钥 是 可 对 其 动作 模式 进行 选择 ， 使 用 示 教 名 上 的 钥 古 选择 T1 模式 
(手动 慢 速 T1 模式 ) ， 在 手动 慢 速 T1 模式 下 机 需 人 运动 速度 为 230mm/s， 可 以 使 用 示 教 纺 
程 表 手动 操作 机 舌 人 动作 。 在 此 模式 下 ， 所 有 程序 都 可 以 在 测试 模式 下 减速 ， 手 动 执 行程 
序 。 程 序 只 有 在 “开始 ” 键 按 下 并 保持 的 情况 下 才 开 始 启动 。 当 释放 “开始 ” 键 时 ， 机 带 
人 会 停止 。 当 再 次 按 下 “局 动 ” 键 后 程序 继续 运行 。 

3) 伺服 上 电 。 图 6-29 所 示 为 机 各 人 使 能 键 位 置 。 在 KUKA 控制 面板 (KCP) 上 有 三 个 
三 位 使 能 键 。 在 Tl 或 T2 模式 下 任 一 使 能 键 和 都 可 用 来 使 机 肯 人 驱动 上 电 。 当 需 移动 机 天 人 
时 ， 应 将 使 能 键 置 于 中 间 位 置 并 保持 。 释 放 或 完全 压 下 “使 能 ” 键 将 触发 制 动 。 














内 部 自动 外 部 自动 
© Ko 
0 © 


手动 快速 T2 手动 慢 速 TI1 





图 6-28 机 右 人 动作 模式 的 选择 图 6-29 ” 示 教 角 “ 使 能 ” 键 位 置 


ns 


(二 ) 机 器 人 动 起 来 
1. 设 定 运动 速度 


使 用 示 教 编程 占 的 状态 键 改 变 机 各 人 的 速度 ， 降 低 机 各 人 动作 的 速度 ， 如 图 6-30 所 示 。 
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图 6-30” 设 定 机 器 人 的 示 教 速度 
2. 机 器 人 坐标 系 
机 器 人 的 工作 条 件 变化 多 端 ， 所 要 完成 的 工序 也 比较 复杂 ， 因 此 需要 正确 定义 机 器 人 的 
运行 轨迹 ; 正确 操控 机 器 人 必须 要 明确 机 器 人 的 坐标 系统 。 每 个 厂家 的 机 器 人 坐标 系 使 用 不 
同 的 标注 方式 ，KUKA 机 器 人 和 用 的 坐标 系 有 : 与 轴 相 关 的 坐标 系统 、 工 具 坐 标 系 、 基 上 坐标 
系 、 全 局 坐标 系 。 表 6-2 所 示 为 各 个 坐标 系 的 含义 。 
表 6-2 KUKA 机 器 人 常用 坐标 系 

















图 示 坐标 系 含 义 

| 轴 坐 标 每 个 机 融 人 转轴 均 可 单独 正 向 或 反 向 运转 

人 工具 坐标 直角 坐标 系 ， 其 原点 在 工具 上 

柜 | 基 ( 座 ) 坐标 直角 坐标 系 ， 其 原点 在 机 器 人 的 底座 中 心 点 

省 全 局 坐标 (世界 坐标 ) 地 点 固定 的 直角 坐标 系统 ， 其 原点 在 机 器 人 的 底座 中 心 点 








各 个 坐标 系统 的 特点 和 用 途 均 不 一 样 : 轴 坐 标 一 般 用 来 操作 机 需 人 各 个 轴 的 运动 〈 如 
末 是 六 个 目 由 度 的 机 天 人 会 有 A, ~ As 六 个 轴 ， 每 个 轴 都 有 上 自己 的 旋转 方向 和 角度 ) ， 机 天 
人 在 运行 过 程 中 需要 各 个 轴 之 间 配 合 运动 ， 有 旋转 也 有 直线 等 ; 全 局 坐标 系统 主要 是 在 编程 


的 时 候 用 来 标定 机 各 人 的 初始 位 置 以 及 
零点 位 置 ， 该 坐标 系统 类 似 于 空间 三 维 
坐标 系统 ; 工具 坐标 主要 是 机 做 人 在 进 
行 实际 工作 时 的 一 个 参照 坐标 系 ， 他 的 
工具 可 以 是 夹具 、 焊 钳 或 者 喷枪 等 ; 基 
坐标 主要 是 机 右 人 相对 于 自 号 的 坐标 系 
统 ， 其 原点 一 般 在 机 项 人 底座 的 中 心 
点 


WYO 




















要 想 正 确 操 控 机 各 人 或 者 正确 定义 
机 从 人 的 行为 ， 必 须 束 悉 机 骨 人 的 坐标 
系统 ， 明 确 在 什么 情况 下 该 采用 何 种 坐 
标 系统 ， 这 样 才 不 会 出 现 安全 事故 。 


“坐标 系 选择 





”手动 模式 选择 
重 手动 移动 刍 
on 








沁 ] 轴 坐 标 系 
必 全 局 坐标 系 


于 工具 坐标 系 
四 基 毕 标 系 















图 6-31 KUKA 机 各 人 坐标 系 选择 


在 机 大 人 手动 操作 过 程 中 ， 坐 标 系 的 切换 使 用 如 图 6-31 所 示 的 状态 键 来 操作 完成 。 首 
先 使 用 手动 模式 状态 键 选择 手动 模式 ， 再 使 用 坐标 系 状 态 键 选择 所 要 使 用 的 坐标 系 。 


三 、KUKA 机 器 人 示 教 编程 


KUKA 机 夫人 系统 具有 目 己 的 编程 语言 ， 


序 的 具体 操作 步骤 如 下 : 


1) 在 主 界面 下 ， 如 图 6-32 所 示 ， 单 击 








1 打开 
2 打印 
3 存档 
4 还 原 
5 改名 
6 软盘 格式 化 
7 属性 

8 第 选 


图 6-32 





9 KUKA 控制 器 结束 





它 是 在 基于 C 语言 的 基础 上 实现 的 。 建 立新 程 


“文件 ”下 拉 荣 单 ， 选 择 “新 建 "。 











新 建 程序 


2) 进入 到 图 6-33 所 示 画 面 ， 通 过 示 教 编程 带 的 键盘 输入 所 建 程序 的 文件 名 称 ， 单 击 
《OK》 键 即 可 。 程 序 命 名 采用 字母 和 数字 ， 尺 量 不 用 其 他 特殊 符号 ， 避 人 免 在 调试 过 程 中 出 现 


问题 。 
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Ls EUEA HET 2.0 
辫 件 编辑 









































































































































配置 显示 准备 运行 虽 令 于 帮助 
KUKS--HGZ1H2Y 全 RCI 本 局 100 专 
”> W]expert_pro 2013-3-28 17:1,,, La 
| 宇 二 Program 中 hh 2z2013-4-10 0:00,.. 


arcHrve: 和 test B9772189 2013-4-24 17:5，， 
、 岂 ]ytm_useraction 2007-1-12 1;25,,, 


Num Cap 日 OB 





TPOV 100% | RName | 12:40 | ~、 


OK 退出 








图 6-33 ”程序 命名 
3) 然后 通过 示 教 编程 器 上 的 “ 方 同 ” 键 选 择 需 要 编辑 的 程序 ， 按 左下 角 软 键 ( 选 定 》 
就 可 打开 程序 ， 如 图 6-34 所 示 。 


[LEUKA HET 2-0 


箭 选 ,用 户 
-HGZ1H2% 人 KRC 肌 

上 Ri 2013-3-28 17:1,.， 

| ES Program 4 2013-4-10 0:00,,, 

辕 (ARCHIVE:NY one 2013-4-24 21;2,,, 

89772189 2013-4-24 17:5,., 

全 tm_useraction 2007-1-1z 1125,,, 





3090 字 节 





TI POY 100% | RName 140 | 








图 6-34 ” 选 定 程 序 





4) 进入 程序 后 ， 显 示 的 是 程序 的 模板 内 容 ， 如 图 6-35 所 示 。 
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改变 移动 折 秋 开 虚 上 一 条 指令 名 选择 确定 参数 资源 管理 器 





图 6-35 程序 编程 界面 
5) 应 在 两 条 PTP HOME a 中 间 增 加 新 的 程序 内 容 ， 机 融 人 在 与 外 围 设备 联机 运行 
时 ,经常 需要 等 待 一 条 启动 指令 ， 才 开始 运行 自己 的 程序 。 例 如 ， 机 器 人 系统 运行 之 前 需要 
得 到 机 器 人 的 数字 输入 端口 5 i “ 真 值 ”信和 号。 首先 添加 一 条 等 等 条件 指令 ， 选 择 菜 
序列 “指令 一 逻辑 一 循环 等 修 ”， 如 图 6-36 所 示 。 
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4 模拟 输出 
5 注解 2 输出 请 
3 Trigeer 
4 IBWS 段 开 / 关 








POY 100% RName | 12:58 


确定 参数 





图 6-36 ”插入 “循环 等 候 ” 指 令 





6) 程序 出 现 等 待 语句， 要 将 其 确定 为 等 符 数 字 输 入 端口 “5” 的 信息 ， 具 体 是 通过 示 


百 v 心 S 


教 编 程 右 上 的 数字 键 ， 输入 数字 “5”， 再 按 右 下 角 的 软 键 《指令 正确 ;>， 如 图 6-37 所 示 。 


/RLAONE. SEC 
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图 6-37 修改 等 待 时 间 
7) 接 下 来 输入 一 条 PTP 运动 指令 ， 选 中 坐标 系 ， 按 住 使 能 键 ， 通 过 《X)》、 《Y)、 
《2Z2)、《A》、《B》、《C》 键 将 机 项 人 移动 到 目标 位 置 ， 单 击 软 键 “ 移 动 ) ， 如 图 6-38 所 示 。 









图 6-38 输入 指令 界面 





8) 如 图 6-39 所 示 ， 通 过 键盘 的 输入 ， 调 整 该 指令 的 运动 参数 ， 完 成 后 再 按 右 下 角 的 软 
键 (指令 正确 >， 即 完成 这 条 PTP 运动 指令 。 
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图 6-39 调整 PTP 指令 参数 
9) 输入 一 条 直线 LIN 运动 指令 ， 按 住 使 能 键 ， 通 过 《X) 、《Y)、《 2Z)、《A)、《B)、 
《C〉 键 将 机 带 人 移动 到 目标 位 置 ， 单 击 软 键 (移动 ;， 操 作 界 面 如 图 6-38 所 示 。 
10) 重复 第 7) 、8) 步 操 作 即 可 。 操 作 结 果 如 图 640、 图 641 所 示 。 
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图 6-40 调整 LIN 指令 参数 


工业 机 器 人 技术 应 用 
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DEF rnel y 
INI 


PTP HONE Vel= 100 $ DEFAULT 

WAIT FOR | IN 5 'rob home to pickup' ) 

: home to pick 

PTP Pl Vel=100 $ PDAT] Tool[I] Base[0] 

LIN pickup Yel=2 m/s CPDAT1 Tool[1] Base[0] 


DOD 


PTPF HONE Vel= 100 $ DEFAULT 
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图 641 LIN 指令 编程 
11) 最 后 添加 一 条 数字 输出 指令 ， 选 择 亲 单 序列 “指令 一 逻辑 一 输出 端 一 输出 端 "， 如 
图 642 所 示 。 
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改变 移动 折 杰 开关 上 一 条 指令 人 名 选择 确定 参数 资源 管理 器 





图 6-42 ”数字 输出 指令 编程 


12) 如 图 6-43 所 示 ， 程 序 出 现 等 竺 语句 ， 通 过 示 教 编程 句 上 的 键 选 择 到 数字 输入 ， 并 
将 其 更 改 为 “TRUE”， 再 按 右 下 角 的 软 键 “ 指 令 正 确 ) ， 即 输入 这 条 等 待 条件 指令 。 








3 EURA HET 加 [jl 
© eele 全] Eo) 
配置 显示 准备 运行 指令 大 助 
1 DEF onel ) 





INE 


FIP HOME Vel= 100 $ DEFAULT 

WAIT FOR 1¢ IN 5 'robh home to pickup' ) 

: home to pick 

FTPF Pl Vel=100 $4 PDATI Tool[1] Base[0] 

LIN pickup Vel=2 m/s CPDAT]I Tool[1] Base[0] 


2 
3 
4 
5 
3 
加 
9 





PTP HOME Vel= 100 所 DEFAULT 


人 bet in_pickup State=|TRUE ™ 








径 
目 
| 








一 二 
入 
一 二 
IOIE. SEC [in 10 Co a8 
CC 时间 | 编 ..| 来 源 | 提 示 | = 
(OD 13:14:01 104 71PB... 点 了 Tl 已 被 自动 建立 一 二 
(DEST ET 点 pickup 已 被 自动 建立 
Num | Can |5 1 轿 R17ONE 有 | IP=8) TI Hov 10% | RName | 13:27 e 
指令 退出 | ”脉冲 | 同步 输出 | 长 文本 | | | 指令 正确 | 





图 6-43 ”修改 输出 指令 参数 
13) 最 后 ， 如 图 644 所 示 ， 选 择 菜单 序列 “编辑 一 程序 复位 ”， 在 Tl 模式 下 进行 程序 
测试 。 使 用 示 教 编程 器 的 使 E 键 使 系统 上 电 ， 按 下 程序 正 向 运行 启动 键 ， 机 希 人 按照 编程 轨 
迹 运动 。 


之 KUKA HET 2.0 辐 回回 











专 DEFAULT 

oh home to pickup! ) 

DaT1 Tool[1] Base[0] 

s CPDATI Tool[1] Base[0] 
ckEup' State=TRUE 


所 DEFAULT 





He es Pe 





RI/DNE. SEC 


C..| 时 间 | 编 ..| 来 源 | 提示 
DD 13:14:01 104 TPB..， 点 fl 已 被 自动 建立 
13:16:37 i104 TFB .， 点 pickup 已 被 自动 建立 























Num | Can sl1 加 R1/ONE LIP=9| TI HOY 10% | RName | 13:29 | 人 
改变 移动 折 得 开 忌 上 一 条 指令 名 选择 确定 参数 资源 管理 器 


图 6-44 ”调试 程序 














\ 工业 机 器 人 技术 应 用 


四 、KUKA 机 器 人 的 常用 示 教 编程 指令 





KUKA 机 天 人 的 运动 主要 有 两 种 形式 : 基于 轴 的 运动 、 基 于 路 径 的 运动 。 基 于 轴 的 运动 
只 考虑 从 起 始点 运动 到 结束 点 ， 中 间 路 径 可 不 予 关 心 。 基 于 路 径 的 运动 需要 考虑 机 希 人 工具 
从 起 始点 运动 到 结束 点 的 过 程 中 是 沿 什么 样 的 路 径 运 动 的 。 因 此 常用 的 运动 编程 指令 为 
PTP、 LIN、 CIRC。, 

(一 ) PTP 指令 

PTP 运动 指令 完成 点 到 点 的 移动 ， 机 需 人 夹 持 工具 的 TCP 点 沿 关 最 快 的 路 径 疝 结束 后 
运动 。 如 图 645 所 示 ， 工 作 空 间 内 机 融 人 始终 在 两 点 之 间 定 位 ， 以 最 快 的 路 径 进 行 ， 而 且 
所 有 轴 的 移动 同时 开始 和 结束 ， 所 有 的 轴 必 须 同步 ， 这 时 无 法 精确 地 预计 机 带 人 的 轨迹 。 采 
用 该 语句 进行 程序 设计 ， 在 实际 操作 过 程 中 容易 出 现 无 法 预知 的 运动 轨迹 ， 容 易 造成 一 定 的 
安全 事故 ， 因 此 在 编程 的 时 候 尽量 不 用 或 者 少 用 该 语句 。 

PTP 运动 指令 语法 格式 如 图 6-46 所 示 ， 参 数 说 明 参 见 表 6-3。 
























































P 
[EP =j Bi |coNT =|vel=[ 00 又 |PDAT1 
Pl 
图 6-45 ”PTP 指令 运动 轨迹 图 646 ”PTP 语法 格式 
表 6-3 PTP 指令 参数 说 明 

窗口 名 称 功 能 数值 范围 
PTP 移动 方式 PTP、 LIN CIRC 
P1 点 的 名 称 
Tool( 工具 ) 工具 编号 零 帧 ，Tool _ Data 1[1] ~ [16j 
Base( 基 坐 标 ) 工件 编号 零 帧 ，Base _ Data 1[1] ~[16|] 
External TCP( 外 部 ) 机 器 人 携带 工具 /工件 True、False( 真 、 伪 ) 
CONT 逼近 开 ”，Cont 
Vel = 100% 速度 最 大 值 的 1% ~100% ( 预 设 值 100% ) 
PDATI1 移动 参数 
Acceleration 加 速度 0 ~ 100 
Approximation 

通 近 区 域 0 ~ 100 

Distance“17” 呈 











Ji “1” 仅 在 “CONT” 接 通 时 才 可 供 选择 。 
(二 ) LIN 指令 
LIN 运动 指令 完成 把 到 扣 线 性 移动 ， 机 侣 人 在 移动 过 程 中 ， 各 转轴 之 间 将 进行 配合 ， 使 
得 工具 及 工件 参照 点 沿 着 一 条 通 往 目 标点 的 路 径 移 动 。 一 般 地 ， 当 必须 按 给 定 的 速度 沿 着 东 
条 精确 的 轨迹 抵达 一 个 点 ， 或 者 如 有 果 因 为 存在 碰撞 可 能 性 ， 不 能 以 PTP 移动 的 方式 抵达 时 





第 六 章 ”工业 机 器 人 的 示 教 编程 A 





些 点 的 时 候 ， 将 采用 线性 移动 。 该 语句 有 两 种 移动 方式 ， 分 别 为 精确 定位 的 移动 和 轨迹 逼近 
的 移动 ， 如 图 647 所 示 。 


精确 定位 逼近 区 域 


请 
Ps 


精确 定位 





a) PI b) 


图 647 LIN 运动 指令 定位 方式 
a) P 点 精确 到 达 b) P 点 晕 近 区 域 


LIN 指令 的 语法 格式 如 图 648 所 示 ， 参 数 说 明 参 见 表 6-4。 
LIN 辐 |P1 [coNT®|Yel=|2 mis[CPDATI 


图 648 LIN 语法 格式 


表 6-4 LIN 指令 参数 说 明 
































窗口 名 称 功 能 数值 范围 
LIN 移动 方式 PTP、 LIN CIRC 
Pl 点 的 名 称 
Tool( 工具 ) 工具 编号 零 帧 ，Tool Data1[1|] ~116| 
Base( 基 坐 标 ) 工件 编号 零 帧 ，Base _ Data 1[1] ~ [16] 
External TCP 机 器 人 携带 工具 /工件 True 、False( 真 、 伪 ) 
CONT 通 近 开 “ ”，Cont 
Vel =2m/s 速度 0. 001 ~2m/s( 预 设 值 2m/s) 
CPDATI1 移动 参数 
Acceleration 加 速度 0 ~100 
Approximation 
Distance“1” a on 











QD “1” 仅 在 “CONT” 接 通 时 才 可 供 选 择 。 


(三 ) CIRC 指令 

CIRC 运动 指令 完成 圆 弧 移 动 ， 工 具 及 工件 的 参照 点 沿 着 一 条 圆 弧 移动 至 目标 点 。 这 条 
轨迹 将 通过 起 始点 、 辅 助 点 和 终点 来 描述 。 上 一 条 移动 指令 的 、 以 精确 定位 方式 抵达 的 目标 
点 可 以 作为 起 始点 ， 其 取向 将 同时 在 整个 路 辅助 点 一 
程 上 发 生 改变 。 如 果 加 工 过 程 应 该 以 给 定 的 
速度 沿 着 一 条 圆 形 轨 迹 进 行 时 ， 将 采用 
CIRC 移动 。 该 语句 也 有 两 种 移动 方式 ， 分 
别 为 精确 定位 的 移动 和 轨迹 逼近 的 移动 ， 如 下 
图 6-49 和 图 6-50 所 示 。 图 649 机 右 人 同 孤 运动 















目标 点 











ts 辅助 点 


nn 


逼近 区 域 






目标 点 


和 党 S 
起 始点 辅助 点 辅助 点 





图 6-50” 圆 弧 运动 定位 方式 


CIRC 指令 的 语法 格式 如 图 6-51 所 示 ， 参 数 说 明 见 表 6-5。 


CONT®| Yel=|2 m/s[CPDATI 





图 6-51 ”CIRC 语法 格式 
表 6-5 CIRC 指令 参数 说 明 



































窗口 名 称 功 能 数值 范围 
CIRC 移动 方式 PIP、LIN CIRC 
P1 辅助 点 的 名 称 
P2 点 的 名 称 
Tool (工具 ) 工具 编号 零 帧 ，Tool Datal [1] ~ [16|] 
Base ( 基 坐 标 ) 工件 编号 去 帧 ，Base _Datal [1] ~ [16] 
External TCP 机 器 人 携带 工具 /工件 True、False ( 真 、 伪 ) 
CONT 逼近 开 “” ”, Cont 
Vel =2m/s 速度 0. 001 ~2m/s( 预 设 值 2m/s) 
CPDAT! 移动 参数 
Acceleration 加 速度 0~100 
Approximation 
至 近 区 域 0 ~100 
Distance “1” 








QD “1” 仅 在 “CONT” 接 通 时 才 可 供 选择 。 
五 、 机 咒 人 点 焊 程 序 示例 


点 焊 机 天 人 系统 利用 金属 与 金属 之 间 的 接触 电阻 ， 通 过 强大 的 电流 ， 使 金属 接触 部 分 局 
部 熔化 ， 形 成 金属 间 的 连接 。 可 以 焊接 低 碳 钢板 、 不 锈 钢 板 、 镀 镑 或 多 功能 铝 钢 板 、 铝 板 、 
铜板 等 薄板 类 焊接 ， 机 釉 人 控制 硕 可 以 根据 不 同 材质 、 不 同 厚 度 确 定 和 调整 焊接 压力 、 焊 接 
电流 等 参数 ， 具 有 焊接 效率 高 、 变 形 小 、 不 需 添 加 焊接 材料 等 特点 。 广 泛 应 用 于 汽车 敌 盖 
件 、 驾 驶 室 、 汽 车 地 板 等 部 件 的 高 质量 焊接 。 

对 于 点 焊 机 做人 系统 的 要 求 一 般 基 于 两 点 考虑 : 一 是 机 豆 人 运动 的 定位 精度 ， 它 由 机 天 
人 机 械 手 和 控制 带 来 保证 ; 二 是 机 各 人 外 围 设备 ， 它 主要 由 阻 焊 变 压 副 、 焊 错 、 点 焊 控 制 帮 
及 水 、 电 、 气 路 及 其 辅助 设备 组 成 。 

KUKA 机 希 人 是 一 种 多 用 途 的 机 需 人 ， 它 可 以 实现 点 焊 、 涂 胶 、 电 弧 焊 和 搬运 等 功能 ， 
它 具 有 良好 的 加 速 性 能 和 速度 较 快 的 特点 ， 在 点 焊 方 面 尤 具 特 色 ， 负 载 200kg 的 机 带 人 焊 操 
的 重复 精度 可 达 + 上 0. 4mm， 因 此 ， 它 广泛 应 用 在 汽车 行业 、 摩 托 车 行业 进行 自动 焊接 。 
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下 面 以 机 融 人 点 焊 车 门 为 例 ， 说 明 焊 接 编程 方法 。 

KUKA 机 大 人 后 焊 焊接 车 门 的 工作 流程 机 带 人 回 至 HOME 操 ， 根 据 工艺 设计 机 带 人 
去 抓 取 需 要 的 点 焊 焊 钳 ， 通 过 目 动 工具 快 换 装 置 携带 X 型 焊 钳 焊接 工件 ， 然 后 将 X 型 焊 钳 
放下 ， 再 更 换 C 型 焊 钳 焊 接 工 件 ， 焊 接 完 毕 后 ， 将 C 型 焊 钳 放 到 焊 钳 文 轩 上 ， 人 工 将 工件 
取出 ， 工 件 焊 接 完 毕 ， 一 个 工作 循环 结 

KUKA 机 禹 人 点 焊 焊 接 指 令 有 SPOT 点 焊 命 令 ，RETR OPN 焊 枪 预 张 开 命 令 ，RETR 
CLS， 焊 枪 预 关闭 命令 ，SDAT 点 焊 参 数 等 。 要 求 机 各 人 在 运行 中 达到 指定 需要 焊接 位 置 时 ， 
进行 点 焊 焊接 ; 完成 相应 的 焊接 任务 后 ， 离 开 焊 接 位 置 。 参 考 程序 如 下 : 














INI; 程序 起 始 行 

PTP HOME Vel =100% DEFAULT; 移动 到 系统 待机 位 置 ， 
HOME 点 位 置 

WAIT FOR(IN 15“PREIPHERAL CONDITIONS OK’ ) ; 等 待 输入 信号 “OK” 


IF $IN[63] ==TRUE THEN ; 
WAIT FOR(IN 64° WATER FLOW’ ) ; 
WAIT FOR(IN 11‘C TORCH IN COVER’ )AND(IN 24 ‘RET OPN’); 
等 待 焊接 系统 信号 正常 运 
行 ， 可 以 开始 焊接 操作 
PTP P19 CONT Vel =50% PDAT8 TOOL[0] BASE[0] ; 移动 到 P19 示 教 位 置 点 
LIN P7 CONT Vel =2m/s CPDAT4 TOOL[0] BASE[0] ; 移动 到 P7 示 教 位 置 点 
LIN P10 CPDATS RETR CLS GUN =1 TOOL[1] BASE[0];” 焊 点 上 方 ， 准备 焊 接 
LIN P11 CPDAT6 SPOT GUN =1 RETR CLS SDAT3 TOOL[0] BASE[0]; 











点 焊 焊 接 
LIN P12 Vel =0. 5m/s CPDAT7 TOOL[0] BASE[0 ] ; 点 焊 结 束 ， 离 开 焊 点 
LIN P13 Vel =2m/s CPDAT8 TOOL[ 0] BASE[0] ; 移动 至 下 一 个 焊 点 上 方 
LIN P14 CPDAT9 SPOT GUN =1 RETR CLS SDAT4 TOOL[0] BASE[0 ] ; 

点 焊 焊 接 
LIN P27 CPDAT15 RETR OPN GUN =1 TOOL[0] BASE[0]; 点 焊 结 束 ， 离 开 焊 点 
LIN P28 Vel = lm/s CPDAT16 TOOL[0] BASE[0 ] ; 移动 至 P28 示 教 位 置 点 


LIN P18 CONT Vel =1m/s CPDAT11 TOOL[0] BASE[0]; ”移动 至 P18 示 教 位 置 点 


eeeee 


PTP HOME CONT Vel =60% _ DEFAULT ; 移动 到 系统 待机 位 置 ， 
HOME 点 位 置 
RETURN ; 程序 结 


第 三 节 ABB 哎 涂 机 费 人 编程 


六 -六 六 六 六 -六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 全 六 六 六 六 六 六 六 全 六 人 六 人 六 
人 人 -全 信人 人 -人 人 人 六 -人 人 人 人 -人 人 AAA 


喷涂 机 需 人 工作 站 采用 ABB 公司 的 喷涂 专用 机 希 人 IRB 540-12，IRB 540 是 一 球面 面 兼 
顾 、 结 构 精 简 的 机 融 人 ， 配 备 独创 的 专利 技术 FLEXWRIST 〈 和 柔性 手腕 ) ， 十 分 方便 人 工 纺 
程 (点 到 点 、 连 续 路 径 )。 控 制 器 采用 S4CPLUS 喷涂 专用 型 。 该 机 器 人 实现 汽车 车 灯 的 喷涂 








NN Tm A 
本 3 
一 、ABB 喷涂 机 器 人 系统 


如 图 6-52 所 示 ， 喷 涂 机 船 人 主要 由 机 融 人 本 体 、 喷 枪 、 控 制 融 、 抽 气 装置 、 操 作 融 等 
组 成 。 


喷漆 室 /危险 区 








Pm 抽 气 装置 操作 器 


图 6-52 ”喷涂 机 器 人 系统 
(一 ) ABB 喷涂 机 器 人 控制 系统 


喷涂 机 需 人 一 般 都 是 六 轴 机 希 人 ， 其 中 4、5、6 分 布 在 机 如 人 的 腕 关 市 部 分 。 各 个 轴 的 
运动 方 四 如 图 6-53 所 示 。 








图 6-53 ”IRB 540 顺 涂 机 带 人 六 轴 运 动 方 向 


喷涂 机 佑 人 可 以 使 用 示 教 编程 句 〈Teach Pendant Unit) 和 控制 右 的 操作 面板 来 与 该 机 天 
人 进行 沟通 交流 操作 。 图 6-54 所 示 为 机 需 人 控制 部 的 操作 面板 。 


第 六 章 ”工业 机 器 人 的 示 教 编程 








主 电源 开关 - 
紧急 叫 停 开关 | 
一 三 
启动 电动 机 净化 完成 指示 器 —— 
0 
关闭 电动 机 灯光 测试 按钮 
启动 高 电压 
关闭 高 电压 


操作 模式 选择 器 有 
高 电压 启动 / 关闭 〈 可 选 ) 计时 圳 





图 6-54 ”喷涂 机 需 人 控制 顺 的 操作 面板 
(二 ) ABB 喷涂 机 器 人 示 教 编程 器 
图 6-55 所 示 为 机 带 人 的 示 教 编程 侨 。ABB 喷涂 机 种 人 采用 专用 的 S4C 型 示 教 编程 大 。 






停止 设备 
启动 设备 


急 停 按 钮 


图 6-55 喷涂 机 需 人 示 教 编程 着 
二 、ABB 喷涂 机 器 人 的 基本 操作 
(一 ) 机 器 人 控制 器 的 启动 操作 


先 将 控制 柜 主 电 源 由 “0” 状态 旋 到 “1” 状态 ， 接 通 主 电 
源 ， 如 图 6-56 所 示 。 

机 秋 人 示 教 编程 名 上 将 显示 系统 局 动 目 检 进程 ， 待 进程 走 完 
后 ， 如 无 故障 系统 将 显示 图 6-57 画面 。 如 出 现 其 他 画面 ， 请 和 完 确 
认 系 统 局 动 的 错误 ， 符 错误 解除 后 方 可 操作 机 各 人 。 在 整个 启动 
流程 期 间 ， 机 带 人 的 功能 会 得 到 广泛 的 检查 。 如 果 有 错误 发 生 ， 
那么 该 错误 将 会 作为 信息 ， 以 纯 文 本 形式 显示 在 “ 示 教 编程 大 ” 
装置 上 报告 ， 并 且 被 记录 到 机 般 人 的 “事件 日 志 ” 中 。 图 6-56 控制 柜 主 电源 开关 
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图 6-57 ”机 器 人 正常 启动 界面 





示 教 编程 角 局 动 完 成 后 ， 打 开 电 源 开 关 ， 接 通电 动机 电源 。 

在 目 动 模式 下 ， 在 操作 面板 上 按 下 “启动 电动 机 ”(MOTOR ON) 按钮 。 

在 手动 模式 下 ,将 “ 示 教 编程 融 ” 上 的 启动 设备 向 里 按 下 一 半 ， 那么 就 可 以 进入 到 
“电动 机 启动 ”( MOTORS ON) 模式 中 ， 如 图 6-58 所 示 。 

如 末 局 动 设备 被 松 开 并 在 半 秒 钟 内 又 被 按 下 ， 那 么 
该 机 器 人 不 会 进入 到 “电动 机 启动 ”( MOTORS ON) 模 
式 中 。 如 果 发 生 这 种 情况 ， 那 么 首先 松 开 启动 设备 ， 然 
后 再 将 启动 设备 癌 里 按 下 一 半 。 

(二 ) 选择 机 器 人 的 操作 模式 

利用 操作 模式 选择 带 就 可 以 来 对 操作 模式 进行 选择 。 

人 图 6-58 手动 模式 下 启动 设备 

将 操作 模式 选择 砷 转 到 “ 目 动 ”模式 。 

生产 作业 过 程 中 ， 如 果 机 器 人 按照 编制 好 的 速度 运行 完整 的 程序 ， 那 么 就 可 以 采用 
“自动 ”模式 。 在 这 种 模式 下 ， 示 教 编 程 锅 上 的 启动 设备 键 失效 ， 并 且 机 带 人 用 来 编辑 程序 
的 功能 也 被 锁定 。 

2. 减速 状态 下 的 手动 模式 (控制 模式 ) 

将 操作 模式 选择 紫 转 到 “TI1” 模 式 。 

如 来 局 堡 控制 功能 处 于 激活 状态 (通过 调用 茶 系 统 参数 ， 可 以 使 用 该 功能 ) ， 那 么 只 要 
松 开 示 教 编程 器 上 的 启动 设备 键 ， 程 序 运行 就 会 立刻 停止 。 

在 编制 程序 时 以 及 在 机 需 人 工作 区 内 工作 时 ， 采 用 减速 状态 下 的 手动 模式 。 在 这 种 模式 
下 ， 无 法 通过 遥控 方式 来 控制 外 部 设备 。 

3. 全 速 状 态 下 的 手动 模式 〈 可 选 ， 测 试 模式 ) 

在 全 速 状态 下 的 手动 模式 中 ， 机 器 人 就 会 以 全 速 运动 。 只 有 经 过 培训 、 有 经 验 的 人 员 才 
可 以 使 用 这 种 操作 模式 。 粗 心 大 意 就 很 可 能 导致 人 身 伤 害 。 

将 操作 模式 选择 右 转 到 “T2” 模 式 。 






停 正 设备 
启动 设备 


操纵 慎 

















局 停 控 制 功 能 现在 处 于 激活 状态 ， 也 就 是 说 ， 只 要 您 松 开 示 教 编程 融 上 的 局 动 设备 键 ， 
程序 运行 就 会 立刻 停止 。 

只 有 在 以 全 速 状态 测试 机 融 人 时 ， 才 可 以 使 用 全 速 状态 下 的 手动 模式 。 

在 这 种 模式 下 ， 无 法 通过 遥控 方式 来 控制 外 部 设备 。 

(三 ) 采用 示 教 编程 器 来 输入 文本 

在 对 文件 、 路 径 、 数 据 等 进行 命名 时 ， 可 以 采用 示 教 融 装 置 来 输入 文本 。 由 于 本 系统 的 
设备 不 提供 字符 键盘 ， 所 以 必须 用 特殊 的 方式 来 使 用 数字 键 ， 如 图 6-59 所 示 。 
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图 6-59 ”输入 文本 的 对 话 框 


0 


具体 操作 如 下 : 

1) 数字 键盘 上 的 按键 与 显示 屏 上 所 选 定 的 字符 一 一 对 应 。 

2) 只 要 按 下 功能 键 二 或 一 就 可 以 选择 一 组 字符 或 者 数字 

3 ) 接 下 数字 键盘 上 的 对 应 按键 也 可 以 选择 _ 组 字符 。 如 果 如 图 6.59 所 示 选 择 和 第 三 组 ， 
那么 按键 7 对 应 M， 按 键 8 对 应 N， 按 键 9 对 应 0， 依 次 类 推 。 

4) 采用 “ 左 箭 头 ” 或 “ 右 箭头 ”将 光标 向 左 或 向 右 移动 。 

5) 只 要 按 下 “删除 ” 键 ， 就 可 以 删除 光标 前 面 的 字符。 

6) 只 要 按 下 屏幕 上 的 a~z 对 应 的 功能 键 ， 就 可 以 在 大 小 写字 母 之 间 来 回转 换 。 

7) 完成 文本 输入 后 ， 按 下 功能 键 “OK”， 结 束 此 次 文本 输入 。 

(四 ) 利用 操纵 杆 来 使 机 器 人 步行 

利用 “ 示 教 编程 右 ” 闭 置 上 的 操纵 杆 来 移动 〈 步 行 ) 机 融 人 ， 使 机 大 人 直线 步行 并 且 
可 以 以 小 步 幅 来 更 轻松 地 准确 定位 机 需 人 ， 称 作 “ 增 量 步 行 ”。 

1] 二 肖 线 步行 

选择 操作 模式 选择 紫 处 于 手动 模式 位 置 “T1” 处 。 选 择机 各 人 移动 疙 置 以 及 直线 移动 
方式 ， 如 图 6-60 所 示 。 

通过 “移动 疹 置 ”(Motion Unit) 按键 ,选择 操纵 机 器 人 。 
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通过 “移动 方式 ”( Motion Type) 按键 ,在 手动 作业 期 间 ， 使 用 操纵 杆 使 机 各 人 沿 需 要 
方 同 移动 。 

主要 选择 有 : 直线 移动 ; 对 特定 机 械 臂 末端 工作 大 (END-EFFECTOR) 重新 定位 ; 轴 
接 轴 运动 〈 第 1 组 : 轴 1、 轴 2、 轴 3; 第 2 组 : 轴 4、 轴 5、 轴 6)。 

如 果 使 用 直线 移动 模式 操作 机 各 人 ， 那 么 机 帮 人 就 会 如 图 6-61 所 示 的 一 样 移动 。 











go| | 二 
一 一 移动 装置 
VY 
A Ye 
四 深入 式 
图 6-60 ”选择 机 器 人 移动 装置 图 6-61 机 器 人 坐标 系 的 X、Y、Z 轴 
以 及 直线 移动 方式 





如 图 6-62 所 示 ， 工具 前 端 参 照 点 会 沿 着 坐标 系统 上 的 轴 做 直线 运动 ， 将 该 点 称 作 
Tool0。 该 点 位 于 水 平 机 械 辟 正面 之 上 手腕 的 正面 中 央 人 处 。 

将 局 动 设备 问 里 按 下 ， 打 开 “ 电 动机 局 动 ” (MOTORS ON) 按钮 。 现 在 ,采用 操纵 杆 
来 使 机 如 人 步行 。 如 图 6-63 所 示 ， 站 在 机 人 右 人 后 面 ，( 您 会 发 现 ) Tool0 沿 厦 站、Y、Z 轴 做 
直线 运动 。 





机 器 人 的 机 
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Dee 
送料 器 附件 ”Tool0( 工具 前 端 
参照 点 ) 
工具 前 端 
图 6-62 Tool0 的 位 置 图 6-63 不 同 操纵 杆 仿 转角 度 下 的 机 带 人 移动 方向 





使 机 各 人 分 别 按照 上 述 X、Y、Z 轴 对 应 的 方 回 步 行 ， 也 可 以 将 操纵 杆 的 不 同 偏转 角度 
结合 起 来 ， 让 机 器 人 同时 向 儿 个 方向 移动 。 

值得 注意 的 是 ， 机 絮 人 速度 的 快慢 取决 于 移动 操纵 杆 的 频率 周期 大 小 。 如 果 起 动 操纵 杆 
的 次 数 越 多 ， 那 么 机 器 人 移动 的 速度 就 会 越 快 。 

2. 精确 定位 

按 下 “步行 ”(Jogging) 键 吕 即 可 打开 “步行 ”窗口 ， 如 图 6-64 所 示 。 

在 示 教 器 右 侧面 板 采 用 下 拉 箭 头 将 光标 (阴影 域 ) 移动 到 “ 增 量 ” ( Incremental ) 域 。 





将 光标 移动 到 “ 增 量 ”( Incremental) 域 后 ， 选 定 “ 增 量 步行 ” (Ineremental Jogging) 功能 。 
“ 增 量 步 行 ”选择 窗口 如 图 6-65 所 示 。 
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图 6-64 “步行 ”窗口 
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图 6-65 “ 增 量 步行 ”( Incremental Jogging) 选择 窗口 


增 量 选项 有 “小 ”(Small)、 机 (Medium)、 “大 ”(Large) 或 “用 户 ”(User) 功能 
键 。 选 择 任意 一 个 选项 ,“ 增 量 步 行 ” (Incremental Jogging) 域内 的 “No”( 否 ) 就 会 被 立 
刻 取消 而 被 新 的 选项 代 竺 。 

每 次 移动 一 下 操纵 杆 ， 机 右 人 就 会 移动 一 步 ， 移 动 的 步 幅 (小 、 中 、 大 或 用 户 自 定义 ) 
将 取决 于 此 处 的 选择 。 

同时 也 可 以 使 用 该 键 局 动 或 中 止 “ 增 量 移 动 ”。 
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(五 ) 机 器 人 控制 器 的 关机 

在 机 釉 人 被 关 财 时 ， 所 有 输出 信号 都 将 被 设置 为 零 ， 这 可 能 会 影响 到 供 料 硕 和 周围 设备 。 
因此 ， 在 关闭 机 带 人 之 前 ,请 首先 检查 确保 在 工作 区 内 的 设备 和 人 员 不 会 受到 任何 伤害 。 

如 果 程 序 还 在 运行 ,那么 只 要 按 下 示 教 编程 项 上 的 停止 设备 〈Stop) 键 就 可 以 停止 该 程 
序 。 

在 完成 这 一 切 之 后 ， 切 断 主 电源 开关 。 

机 硕 人 的 内 存 是 由 电池 驱动 的 ， 因 此 在 系统 关闭 时 并 不 会 受到 影响 。 

具体 关机 操作 如 下 : 

按 下 思 | 按 钮 后 ， 转 到 系统 控制 界面 ， 按 上 下 光标 键 选 择 第 二 项 “Service” 选 项 ， 如 图 
6-66 所 示 ， 再 按 “ 回 车 ” 键 国 1 
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图 6-66 关机 操作 步骤 系统 控制 界面 





按 下 “File” 按 钮 ,用 光标 键 选 择 到 “Shutdown” 选 项 ， 如 图 6-67 所 示 ， 再 按 回 车 键 
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图 6-67 ”关机 操作 步骤 File 界面 
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此 时 会 出 现下 面 的 窗口 ， 要 求 确认 关机 操作 ， 如 图 6-68 所 示 。 如 确实 要 关机 ， 按 OK 
键 ， 如 不 想 关 机 ， 可 按 Cancel 键 取消 前 面 的 操作 。 
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Marning! 






shutdown commanmd! 
Do YOU wish to shutdown 
the controller. 








ok to continmnuer? 





图 6-68 ”关机 确认 界面 





按 下 确认 键 后 控制 融会 进行 关机 准备 操作 ， 当 有 可 以 安全 关闭 控制 紫 的 提示 后 ， 即 可 将 
控制 柜 的 主 电源 拨 到 “0” 位 置 ， 关 机 完毕 。 

(六 ) 机 器 人 重启 操作 

当 对 机 如 人 内 部 参数 ( 如 信号 定义 ) 做 过 修改 后 ， 要 重新 启动 机 紫 人 才能 使 改动 生效 ， 
这 0 操作 。 

一 步 与 关机 操作 一 样 ， 第 二 步 时 选择 “Restart” 选 项 ， 如 图 6-69 所 示 ， 回 车 确认 。 
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图 6-69 重 局 界面 


这 时 也 会 出 现 关机 操作 类 似 的 确认 窗口 ， 如 几 6-70 所 示 ， 对 操作 进一步 确认 后 点 OK 
键 。 系 统 将 自行 重新 局 动 ， 回 到 开机 初始 窗口 。 
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Harminmng! 







Restart command! 
Do YOU wish to restart 
the controller. 






OK to continuer? 


图 6-70 重 局 确认 界面 


三 、ABB 喷涂 机 严 人 示 教 编程 



































ABB 机 大 人 的 程序 采用 RAPID 编程 语言 进行 编程 。RAPID 是 一 种 英文 编辑 语言 ， 所 包 
通常 情况 下 由 三 个 不 同 部 分 构成 ， 一 
个 主 程序 (总 是 存在 的 ) 以 及 大 量 的 
时 主 程序 的 第 一 个 指令 也 被 选 定 (时 突出 显示 状态 )。 
(一 ) 喷涂 机 器 人 编程 命令 


含 的 指令 可 以 移动 机 器 人 、 设 定 输 a 
Rede 程序 数据 机 器 人 位 置 
出 、 读 取 输 入 ， 还 能 实现 决策 、 重 复 计数 器 (其 他 等 ) 
0 

所 口 [ 溉 兆 每 个 程 口 、 
子 程序 和 程序 数据 。 每 个 程序 只 允许 Mo 
有 一 个 主 程序 ， 如 图 6-71 所 示 。 

如 果 打 开 一 个 程序 ， 那 么 该 程序 图 6-71 程序 结构 

子 程序 由 不 同类 型 的 指令 构成 ， 比 如 “移动 ”指令 、“ 等 候 ” 指 令 等 。 每 个 指令 都 跟随 
有 不 同 的 参数 。 根 据 其 类 型 ， 参 数 可 以 被 一 同 修改 或 忽略 。 在 图 6-72 中 显示 了 喷涂 机 器 人 
编程 一 个 指令 示例 。 


交流 等 。 一 个 RAPID 语言 编写 的 程序 
就 会 取代 机 器 人 内 存 中 的 程序 。 如 果 一 个 程序 被 打开 ， 那 么 主 程序 就 会 显示 在 显示 屏 上 ， 同 
在 图 6-72 中 ， 程 序 指令 行 各 参数 的 含义 如 下 : 











1. PaintL 

PaintL 是 直线 移动 机 龙 人 指令 的 名 称 。 

2. +* 

此 位 置 为 示 教 点 的 名 称 ，* 为 隐藏 指令 位 置 的 值 。 
3. v1000 


此 位 置 为 确定 机 磊 人 的 速度 ，v1000 是 指 机 帮 人 运行 速度 为 1000mm/s。 


4. z50 


此 位 置 为 确定 机 人 硕 人 位 置 的 精确 度 ， 参 数 确定 机 敌人 是 否 完全 通 近 示 教 点 。 
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PaintL *, v1000, z50, tool0; 


图 6-72 “移动 ”指令 示例 

$5. Tool0 

此 处 指明 哪个 工具 处 于 激活 状态 。Tool0 表示 此 处 机 器 人 使 用 的 工具 名 称 为 Tool0。 

示 教 程序 前 要 分 析 工 件 工 艺 要 求 ， 并 以 方便 机 带 人 运行 的 方 回 定位 。 示 教 时 可 以 先 在 工 
件 上 规划 出 喷漆 的 路 径 ， 并 用 市 颜色 的 笔 标 出 ， 然 后 按照 画 出 的 路 径 示 教程 序 。 

(二 ) 机 器 人 运动 速度 的 修改 

除了 在 程序 中 设 定 机 器 人 的 运动 速度 外 ， 在 机 器 人 运 劲 前 也 可 以 修改 其 运动 速度 。 

按 下 “列表 ”(List) 按键 ， 选 定 窗 口 的 上 半 部 分 。 

按 下 “ -多 ” 功 能 键 ， 如 图 6-73 就 可 以 将 速度 降低 到 75% 。 修 改 速 度 时 ， 速 度 增 量 每 
次 只 能 增加 5% 。 
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图 6-73 ”修改 速度 窗口 
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将 光标 返回 到 程序 的 第 一 行 ， 回 到 运行 程序 窗口 ， 如 图 6-74 所 示 。 此 时 机 恬 人 运动 速 
度 已 经 为 原来 的 75% 。 
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图 6-74 ”运行 程序 窗口 


(三 ) 喷漆 量 大 小 的 调 定 

根据 所 喷涂 工艺 要 求 的 不 同 ， 可 以 对 喷 潜 量 大 小 进行 实时 监控 调节 。 在 图 6-74 所 示 的 
运行 程序 窗口 ， 打开 “Paint” 下 拉 沫 单 ， 对 喷枪 的 喷漆 量 大 小 、 喷 漆 的 鹿 形 面 等 参数 进行 
调节 ， 以 实时 达到 不 同 的 喷涂 工艺 要 求 。 

示 教 过 程 中 为 保证 工艺 参数 稳定 ， 一 定 要 尽量 保持 喷漆 方向 垂直 于 工件 表面 ， 同 时 距 
离 、 速 度 等 基本 保持 恒定 。 

(四 ) 程序 调试 过 程 

由 于 各 个 喷漆 件 的 作业 流程 是 一 样 的 ， 程 序 调试 人 员 要 做 的 工作 就 是 在 相应 的 程序 段 上 
添加 机 釉 人 的 运动 指令 ， 并 在 调试 完毕 后 保存 。 

为 了 保证 机 天 人 在 运动 过 程 中 工艺 的 稳定 〈 速 度 、 距 离 恒定 ) ， 需 要 定义 喷枪 喷射 方 回 
上 茶 一 点 的 用 户 工具 坐标 系 〈Tool User) ， 并 以 此 坐标 系 为 当前 坐标 系 示 教 程序 。 工 具 坐 标 
系 与 喷漆 运行 速度 分 别 定义 ， 方 便 调整 。 




















四 、 机 器 人 程序 运行 


(一 ) 运行 程序 

使 用 功能 键 使 程序 开始 运行 。 其 中 所 用 功能 键 为 : 

1)“ 开 始 ”( Start) 。 持 续 运 行程 序 

2) “前 进 ”(FWD) 。 前 进 到 下 一 个 指令 

3)“ 后 退 ”(BWD)。 后 退 到 下 一 个 指令 

4)“ 指 令 窗 口 ”(INSTR - > )。 再 次 选 定 程 序 指令 徐 口 

按 下 “开始 ”(Start)、“ 前 进 ”(FWD) 或 “后 退 ”(BWD) 这 三 个 选项 中 的 一 个 时 ， 
程序 指示 字 (Program Pointer) 会 指出 ， 和 采用 哪 一 个 指令 ， 程 序 会 开始 运行 。 
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值得 注意 的 是 ， 现 在 程序 可 以 被 运行 启动 了 。 因 此 ， 必 须 确保 没有 人 在 机 需 人 周围 的 警 
忒 区 内 。 

只 要 按 下 启动 设备 并 按 下 “前 进 ”(FWD) 功能 键 就 可 以 开始 运行 程序 。 

程序 开始 运行 后 ， 一 个 单项 指令 会 得 到 执行 ， 然 后 程序 会 停止 。 按 下 “前 进 ” (FWD) 
功能 键 就 会 进入 到 下 一 个 指令 ， 再 按 该 功能 键 又 会 进入 到 再 下 一 个 指令 ， 依 次 类 推 。 

这 样 一 个 接 一 个 地 就 可 以 执行 完 所 有 的 程序 指令 。 在 机 侣 人 到 位 后 ， 重 复 按 下 “前 进 ” 
(FWD) 功能 键 。 

如 果 程 序 已 经 完成 了 最 后 一 道 指 令 ， 而 仍然 按 下 “前 进 ”(FWD) 功能 键 ， 那 么 程序 又 
会 从 开始 的 指令 重新 开始 运行 。 

如 同 以 前 的 做 法 一 样 ， 将 光标 移动 到 “运行 ” (Running) 域 , 然后 改变 到 “循环 ” 
(Cycle) 执行 状态 。 然 后 再 将 光标 返回 到 程序 中 。 

按 下 “开始 ”(Start) 键 就 可 以 开始 运行 程序 了 。 

如 果 “ 循 环 ”( Cycle) 执行 状态 被 选 是 ， 那 么 该 程序 就 会 一 次 性 (一 个 周期 ) 地 被 执 
行 完 。 

然后 再 选 是 “持续 ”( Continuous) 执行 状态 。 

(二 ) 停止 程序 

按 下 “ 示 教 编程 胡 ” 装 置 上 的 “停止 ”(Stop) 键 ， 如 图 6-75 所 示 ， 就 可 以 集 止 程序 。 
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图 6-75 “ 示 教 编程 器 ”装置 上 的 “停止 ”( Stop) 键 


五 、 机 器 人 喷涂 程序 


ABB 公司 的 IRB 540 机 带 人 是 一 种 人 性 化 的 智能 喷涂 机 带 人 ， 该 机 右 人 能 最 大 程度 地 提 
高 喷涂 性 能 ， 降 低 生 产 成 本 ， 并 能 稳定 维持 优异 的 涂 闭 品 质 ， 减 少 过 喷 现 象 ， 降 低 原 料 的 耗 
用 与 浪费 。 如 图 6-76 所 示 喷 涂 机 舌 人 ， 机 融 人 本 体 应 配 有 防护 服 ， 工 作 时 应 穿 好 防护 服 ， 
以 防止 油漆 及 溶剂 对 机 体 污 染 和 腐蚀 。 长 时 间 处 于 备用 状态 时 ， 必 须 及 时 清理 防护 服 后 穿戴 
好 ， 保 持 机 促 人 本 体 的 清洁 。 

ABB 喷涂 机 帮 人 顺 涂 过 程 中 ,喷枪 并 不 是 一 直 处 在 打开 状态 ， 只 有 在 工件 上 方 需 要 出 
漆 时 喷枪 才 会 打开 ， 在 不 需要 时 ,要 及 时 关闭 胶 枪 。ABB 喷涂 机 部 人 有 专用 的 喷涂 指令 
“PaintL”。 下 面 以 喷涂 机 各 人 喷涂 车 灯 为 例 ， 参 考 程序 如 下 : 
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图 6-76 ”喷涂 机 需 人 工作 环境 


MODULE MAINModule 

PROC Main 

MoveJ phome ,v1000 ,z100 ,tooll \wobj: = wobjl1; 移动 到 系统 待机 位 置 ,HOME 点 位 置 
MoveJj p10 ,v1000 ,z100 ,tooll \wobj : = wobjl ; 移动 至 嘎 涂 起 始 位 置 的 上 方 附近 位 置 





MoveL p20 ,v200 ,fine , tooll \wobj : = wobjl ; 移动 至 喷涂 开始 点 位 置 

PaintL p30 ,v200 ,z10 ,tooll \wobj: = wobjl ; 开局 喷枪 开始 嘎 涂 

PaintL p40 ,v200 ,z10 ,tooll \wobj: = wobjl ; 喷涂 至 p40 示 教 点 

PaintL p50 ,v200 ,z10 ,tooll \wobj: = wobjl ; 喷涂 至 p50 示 教 点 

MoveL p300 ,v200 ,z50 ,tooll \wobj : = wobjl ; 移动 至 喷涂 结束 点 位 置 

MoveL p310 ,v200 ,z50 ,tooll \wobj: = wobjl ; 移动 至 喷涂 起 始 位 置 的 上 方 附 近 位 置 
Move] phome ,v1000 ,z100 ,tooll \wobj: = wobjl1; ”移动 到 系统 待机 位 置 ,HOME 点 位 置 
ENDPROC 


ENDMODULE 
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工业 机 器 人 离线 编程 及 仿真 


伴随 着 工业 机 顺 人 的 发 展 ， 机 融 人 的 语言 也 得 到 了 发 展 和 完善 。 机 需 人 语言 已 经 成 为 机 
信人 技术 的 一 个 重要 部 分 。 工 业 机 和 右 人 的 功能 除了 依 徘 机 带 人 人 硬件 支持 以 外 ， 相 当 一 部 分 还 
需要 依赖 机 大 人 语言 来 完成 。 早 期 的 工业 机 各 人 由 于 功能 单一 、 动 作 简 单 ， 可 采用 固定 程序 
或 示 教 方式 来 控制 机 各 人 的 运动 。 随 着 机 大 人 作业 动作 的 多 样 化 和 作业 环境 的 复杂 化 ， 依 徘 
回 定 的 程序 或 示 教 方式 已 经 满足 不 了 要 求 ， 必 须 依 徘 能 适应 作业 和 环境 随时 变化 的 机 右 人 语 
言 编程 来 完成 机 硕 人 的 工作 。 工 业 机 需 人 的 程序 编制 是 机 需 人 运动 和 控制 的 结合 点 ， 是 实现 
人 与 机 表 人 通信 的 主要 方法 ， 也 是 研究 工业 机 釉 人 系统 的 关键 问题 之 一 。 


第 一 避 机 费 人 的 语言 类 型 














一 、 对 机 器 人 的 编程 要 求 


(一 ) 能 够 建立 世界 模型 ( World Model) 

机 各 人 编程 需要 一 种 描述 物体 在 三 维 空间 内 运动 的 方法 。 存 在 具体 的 几何 形式 是 机 个人 
编程 语言 最 普通 的 组 成 部 分 。 物 体 的 所 有 运动 部 以 相对 于 基 上 坐标 系 的 工具 坐标 来 描述 。 机 融 
人 语言 应 当 具 有 对 世界 (环境) 的 建 模 功 能 。 

(二 ) 能 够 描述 机 器 人 的 作业 

对 机 船 人 作业 的 描述 与 其 环境 模型 密切 相关 ， 描 述 水 平 决 定 了 编程 语言 水 平 。 其 中 以 自 
然 语 言 输入 为 最 高 水 平 。 现 有 的 机 胡 人 语言 需要 给 出 作业 顺序 ， 由 语法 和 词法 定义 输入 语 
言 ， 并 由 它 描 述 整个 作业 。 

(三 ) 能 够 描述 机 器 人 的 运动 

机 融 人 编程 语言 的 基本 功能 之 一 驶 是 描述 机 秀 人 需要 进行 的 运动 。 用 户 能 够 运用 语言 中 
的 运动 语句 ， 与 规划 需 和 发 生 硕 连接 ， 人 允许 用 户 规定 路 径 上 的 点 及 目标 点 ， 决 定 是 否 采用 点 
插 补 运动 或 稍 卡 儿 直 线 运动 。 用 户 还 可 以 控制 运动 速度 或 运动 持续 时 间 。 

(四 ) 允许 用 户 规定 执行 流程 

机 各 人 编程 系统 允许 用 户 规定 执行 流程 ， 包 括 实验 和 转移 、 循 环 、 调 用 子 程序 以 至 中 断 
等 ， 这 与 一 般 的 计算 机 编程 语言 一 样 。 

(五 ) 要 有 良好 的 编程 环境 

一 个 好 的 计算 机 编程 环境 有 助 于 提高 程序 员 的 工作 效率 。 机 械 手 的 编程 比较 困难 ， 其 编 
程 趋向 于 试探 对 话 式 。 如 果 用 户 忙于 应 付 连 续 重 复 的 编译 语言 的 编辑 -编译 -循环 执行 ， 那 么 
其 工作 效率 必然 是 低 的 。 因 此 ， 现 在 大 多 数 机 各 人 编程 语言 含有 中 断 功 能 ， 以 便 能 够 在 程序 
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开发 和 调试 过 程 中 每 次 执行 只 执行 一 条 单独 语句 。 上 典型 的 编程 支撑 ( 如 文本 编辑 调试 程序 ) 
和 文件 系统 也 是 需要 的 。 

(六 ) 需要 人 机 接口 和 综合 传 感 信号 

要 求 在 编程 和 作业 过 程 中 ,便于 人 与 机 带 人 之 间 进 行 信息 交换 ， 以 便 在 运动 出 现 故 障 时 
能 及 时 处 理 ， 确 保安 全 。 而 且 ， 随 着 作业 环境 和 作业 内 容 复 杂 程 度 的 增加 ， 和 需要 有 功能 强大 
的 人 机 接口 。 

机 各 人 语言 一 个 极其 重要 的 部 分 是 与 传 感 右 相互 作用 。 语 言 系 统 应 能 提供 一 般 的 决 集结 
构 ， 以 便 根据 传 感 融 的 信息 来 控制 程序 的 流程 。 


二 、 机 器 人 编程 语言 的 类 型 


机 大 人 的 语言 尽管 有 很 多 分 类 方法 ,但 根据 作业 描述 水 平 的 高 低 ， 通 常 可 分 为 三 级 动作 
级 、 对 象 级 、 任 务 级 。 

(一 ) 动作 级 编程 语言 

动作 级 语言 是 以 机 器 人 的 运动 为 描述 中 心 ， 通常 由 指挥 夹 手 从 一 个 位 置 到 男 一 个 位 置 的 
一 系列 命令 组 成 。 动 作 级 语言 的 每 个 命令 (指令) 对 应 于 一 个 动作 。 如 可 以 定义 机 器 人 的 
运动 序列 (MOVE ) ， 基 本 语句 形式 为 

MOVE TO (Destination ) 

动作 级 的 语言 代表 是 VAL 语言 ， 它 的 语句 比较 人 简单， 易于 编程 。 动 作 级 语言 的 缺点 是 
不 能 进行 复杂 的 数学 运算 ， 不 能 接收 复杂 的 传 感 信 息 ， 仅 能 接收 传 感 硕 的 开关 信号 ， 并 且 和 
其 他 计算 机 的 通信 能 力 很 差 。VAL 语言 不 提供 浮 点 数 或 字符 串 ， 而 且 子 程序 不 含 自 变量 。 

动作 级 编程 又 可 分 为 关节 级 编程 和 终端 执行 锅 级 编程 两 种 。 

1. 关节 级 编程 

关 广 级 编程 程序 给 出 机 絮 人 各 关 市 位 移 的 时 间 序 列 。 这 种 程序 可 以 用 汇编 语言 、 简 单 的 
编程 指令 实现 ， 也 可 通过 示 教 器 示 教 或 者 键 和 人 示 教 实现 。 

关节 级 编程 是 一 种 在 关节 坐标 系 中 工作 的 初级 编程 方法 ， 用 于 直角 坐标 型 机 器 人 和 圆柱 
坐标 型 机 项 人 编程 。 

2. 终端 执行 器 级 编程 

余 端 执行 器 级 编程 是 一 种 在 作业 空间 内 直角 坐标 系 里 工作 的 编程 方法 。 

终端 执行 升级 编程 程序 给 出 机 器 人 终端 执 行 恬 的 位 姿 和 辅助 机 能 的 时 间 序 列 ， 包 括 力 
、 触 觉 、 视 觉 等 机 能 以 及 作业 用 量 、 作 业 工 具 的 选 定 等 。 这 种 语言 的 指令 系统 由 系统 软件 
释 执行 。 可 提供 简单 的 条 件 分 支 ， 可 应 用 子 程序 ， 并 提供 较 强 的 感受 处 理 功 能 和 工具 使 用 
能 ， 这 类 语言 有 的 还 具有 并 行 功能 。 

(二 ) 对 象 级 编程 语言 

对 象 级 语言 解决 了 动作 级 语言 的 不 足 ， 它 是 描述 操作 物体 间 的 关系 使 机 句 人 动作 的 语 
， 即 是 以 描述 操作 物体 之 间 的 关系 为 中 心 的 语言 ， 这 类 语言 有 AML、AUTOPASS 等 。 
AUTOPASS 是 一 种 用 于 计算 机 控制 下 进行 机 械 零 件 装 配 的 自动 编程 系统 ， 这 一 编程 系统 
面 对 对 象 级 装配 操作 ， 而 不 直接 面 对 装 配 机 需 人 的 运动 。 

(三 ) 任务 级 编程 语言 

任务 级 语言 是 比较 高 级 的 机 器 人 语言 ， 这 类 语言 允许 使 用 者 对 工作 任务 所 要 求 达 到 的 目 
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标 直 接 下 命令 ， 不 需要 规定 机 融 人 所 做 的 每 个 动作 的 细节 。 只 要 按 某 种 原则 给 出 最 初 的 环境 
模型 和 最 终 工 作 状 态 ， 机 顺 人 可 目 动 进行 推理 、 计 算 ， 最 后 目 动 生 成 机 顺 人 的 动作 。 任 务 级 
语言 的 概念 类 似 于 人 工 智 能 中 程序 自动 生成 的 概念 。 任 务 级 机 骨 人 编程 系统 能 够 自动 执行 许 
多 规划 任务 。 

各 种 机 做 人 编程 语言 有 不 同 的 设计 特点 ， 它 们 是 由 许多 因素 决定 的 。 这 些 因 和 又 包括 : 

1) 语言 模式 ， 如 文本 、 清 单 等 。 

2) 语言 形式 ， 如 子 程序 、 新 语言 等 。 

3) 几何 学 数据 形式 ， 如 坐标 系 、 关 节 转 角 、 秋 量变 换 、 旋 转 以 及 路 径 等 。 

4) 旋转 矩阵 的 规定 与 表示 ， 如 旋转 矩阵 、 矢 量 角 、 四 元 数组 、 欧 拉 角 以 及 深 动 - 偏 航 - 
俯仰 角 等 。 

5) 控制 多 个 机 械 手 的 能 

6) 控制 结构 ， 如 状态 标记 等 。 

7) 控制 模式 ， 如 位 置 、 偶 移 力 、 和 柔顺 运动 、 视 觉 伺 服 、 传 送 带 及 物体 跟踪 等 。 

8) 运动 形式 ， 如 两 点 间 的 坐标 关系 、 两 点 间 的 直线 、 连 接 几 个 点 、 连 续 路 径 、 隐 式 几 
何 图 形 等 。 

9) 信号 线 ， 如 二 进 制 输入 /输出 、 模 拟 输 入 /输出 等 。 

10) 传 感 融 接口 ， 如 视觉 、 力 /力矩 、 接 近 度 传 感 硕 和 限 位 开关 等 。 

11) 支援 模块 ， 如 文件 编辑 程序 、 文 件 系 统 、 解 释 程序 、 编 译 程序 、 模 拟 程序 、 宏 程 
序 、 指 令 文件 、 分 段 联机 、 差 错 联机 等 。 

12) 调试 性 能 ， 如 信号 分 级 变化 、 中 断 点 和 自动 记录 等 。 
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一 、 机 器 人 语言 系统 的 结构 


如 同 其 他 计算 机 语言 一 样 ， 机 需 人 语言 实际 上 是 一 个 语言 系统 ， 机 融 人 语言 系统 既 包 含 
语言 本 里 一 一 给 出 作业 指示 和 动作 指示 ， 同 时 又 包含 处 理 系统 一 一 根据 上 述 指示 来 控制 机 带 











人 系统 。 机 兹 人 语言 系统 如 图 7-1 所 示 ， 它 能 够 文 持 机 需 人 编程 、 控 制 ， 以 及 与 外 围 设 备 、 


与 计算 机 系统 的 通信 














图 7-1 机 船 人 语言 系统 
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传 感 硕 和 机 需 人 接口 ; 同时 还 支持 和 计算 机 系统 的 通信 。 

机 各 人 的 语言 系统 包括 三 个 基本 的 操作 状态 ， 监控 状态 ; 编辑 状态 ; 执行 状态 。 

监控 状态 是 用 来 进行 整个 系统 的 监督 和 控制 的 。 在 监控 状态 ， 操 作者 可 以 用 示 教 融 定 义 
机 希 人 在 空间 的 位 置 ， 设 置 机 硕 人 的 运动 速度 ， 存 储 和 调 出 程序 等 。 

编辑 状态 是 提供 操作 者 编制 程序 或 编辑 程序 的 。 尺 管 不 同 语言 的 编辑 操作 不 同 ， 但 一 般 
均 包 括 写 入 指令 、 修 改 或 删除 指令 以 及 插入 指令 等 。 

执行 状态 是 用 来 执行 机 融 人 程序 的 。 在 执行 状态 ， 机 各 人 执行 程序 的 每 一 条 指令 ， 操 作 
者 可 通过 调试 程序 来 修改 错误 。 例 如 ， 在 程序 执行 过 程 中 ， 某 一 位 置 关节 角 超过 限制 ， 因 此 
机 右 人 不 能 执行 ， 在 CRT 上 显示 错误 信息 ， 并 停止 运行 。 操 作者 可 返回 到 编辑 状态 修改 程 
序 。 大 多 数 机 融 人 语言 允许 在 程序 执行 过 程 中 ， 直 接 返回 到 监控 或 编辑 状态 。 

和 计算 机 编程 语言 类 似 ， 机 带 人 语言 程序 可 以 编译 ， 即 把 机 各 人 源 程 序 转换 成 机 带 人 码 ， 
以 便 机 胡 人 控制 柜 能 直接 读 取 和 执行 ; 编译 后 的 程序 ， 运 行 速度 将 大 大 加 快 。 


二 、 机 器 人 编程 语言 的 基本 功能 


机 器 人 的 任务 程序 员 通 过 编程 能 够 指挥 机 器 人 系统 去 完成 的 分 立 单 一 动作 就 是 基本 程序 
功能 。 例 如 把 工具 移动 至 某 一 指定 位 置 ， 操 作 未 端 执 行 装置 ， 从 传感器 或 手动 输入 装置 读数 
等 。 机 需 人 工作 站 系统 程序 员 的 责任 是 选用 一 套 对 作业 程序 员工 作 最 有 用 的 基本 功能 。 这 些 
基本 功能 包括 运算 、 决 策 、 通 信 、 机 械 手 运动 、 工 具 指 令 以 及 某 些 简单 的 传 感 右 数据 处 理 功 
能 。 

(一 ) 运算 

在 作业 过 程 中 执行 的 规定 运算 能 力 是 机 器 人 控制 系统 的 最 重要 能 力 之 一 。 如 果 机 顺 人 未 
装 有 任何 传 感 希 ， 那 么 就 可 能 不 需要 对 机 器 人 程序 规定 什么 运算 。 没 有 传感器 的 机 器 人 只 不 
过 是 一 台 适 于 编程 的 数控 机 器 。 

装 有 传感器 的 机 器 人 所 进行 的 一 些 最 有 用 的 运算 是 解析 几何 计算 。 这 些 运算 结果 能 使 机 
器 人 上 自行 做 出 决定 在 下 一 步 把 工具 或 夹 手 置 于 何 处 。 

(二 ) 决策 

机 需 人 系统 能 够 根据 传 感 硕 输入 信息 做 出 决策 ， 而 不 必 执 行 任何 运算 。 用 未 处 理 的 传 感 
器 数据 计算 得 到 的 结果 ， 是 做 出 下 一 步 该 干什么 这 类 决策 的 基础 。 这 种 决策 能 力 使 得 机 需 人 
控制 系统 的 功能 更 强 有 力 。 

(三 ) 通信 

机 器 人 系统 与 操作 人 员 之 间 的 通信 能 力 ， 人 允许 机 融 人 要 求 操 作 人 员 提 供 信息 、 告 诉 操 作 
者 下 一 步 该 干什么 ， 以 及 让 操作 者 知道 机 器 人 打算 干什么 。 人 与 机 器 能 够 通过 许多 不 同方 式 
进行 通信 。 

(四 ) 机 械 手 运动 

可 用 许多 方法 来 规定 机 械 手 的 运动 。 最 简单 的 方法 是 向 各 关节 伺服 装置 提供 一 组 关节 的 
位 置 ， 然 后 等 待 伺服 装置 到 达 这 些 规定 位 置 。 比 较 复 杂 的 方法 是 在 机 械 手 工作 空间 内 插入 一 
些 中 间 位 置 。 这 种 程序 使 所 有 关节 同时 开始 运动 和 同时 停止 运动 。 用 于 机 械 手 的 形状 无 关 的 
坐标 来 表示 工具 位 置 是 更 先进 的 方法 ， 而 且 ( 除 X-Y-Z 机 械 手 外 ) 需要 用 一 台 计 算 机 对 解 
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符 进 行 计算 。 在 笛 卡 儿 空 间 内 插入 工具 位 置 能 使 工具 端点 沿 着 路 径 跟 随 轨迹 平滑 运动 。 引 入 
一 个 参考 坐标 系 ， 用 以 描述 工具 位 置 ， 然 后 让 该 坐标 系 运动 。 这 对 许多 情况 是 很 方便 的 。 

(五 ) 工具 指令 

一 个 工具 控制 指令 通常 是 由 闭合 某 个 开关 或 继电器 而 开始 触发 的 ， 而 继电器 又 可 能 把 电 
器 连通 或 断 开 ， 以 直接 控制 工具 运动 ， 或 者 送出 一 个 小 功率 信和 号 给 电子 控制 器 ， 让 后 者 去 控 
制 工 具 。 直 接 控制 是 最 简单 的 方法 ， 而 且 对 控制 系统 的 要 求 也 较 少 。 可 以 用 传 感 硕 来 感受 工 
具 运 动 及 其 功能 的 执行 情况 。 

(六 ) 传感器 数据 处 理 

用 于 机 械 手 控制 的 通用 计算 机 上 只 有 与 传感器 连接 起 来 ， 才 能 发 挥 其 全 部 效用 。 传 感 器 具 
有 多 种 形式 ， 按 照 功 能 ， 把 传感器 概括 如 下 : 

1) 内 体感 受 器 用 于 感受 机 械 手 或 其 他 由 计算 机 控制 的 关节 式 机 构 的 设置 。 

2) 触觉 传感器 用 于 感受 工具 与 物体 〈 工 件 ) 间 的 实际 接触 。 

3) 接近 度 或 距离 传感器 用 于 感受 工具 至 工件 或 障 但 物 的 距离 。 

4) 力 和 力矩 传 感 锅 用 于 感受 装配 时 所 产生 的 力 和 力矩 。 

5) 视觉 传感器 用 于 “看 见 ” 工 作 空 间 内 的 物体 ， 确 定 物 体 的 位 置 或 识别 他 们 的 形状 












































传 感 卓 数据 处 理 是 许多 机 侣 人 程序 编制 十 分 重要 而 又 复杂 的 组 成 部 分 。 
三 、 常 用 的 机 器 人 编程 语言 


(一 ) VAL 语言 及 特点 

VAL 语言 是 美国 Unimation 公司 于 1979 年 推出 的 一 种 机 各 人 编程 语言 ， 主 要 配置 在 PU- 
MA 和 Unimation 等 型 机 器 人 上 ， 是 一 种 专用 的 动作 类 描述 语言 。VAL 语言 是 在 BASIC 语言 
的 基础 上 发 展 起 来 的 ， 所 以 与 BASIC 语言 的 结构 很 相似 。 在 VAL 的 基础 上 Unimation 公司 推 
出 了 VALI 语 言 。 

VAL 语言 可 应 用 于 上 下 两 级 计算 机 控制 的 机 顺 人 系统 。 上 位 机 为 LSI-11/23 ， 编 程 在 上 
位 机 中 进行 ， 上 位 机 进行 系统 的 管理 ; 下 位 机 为 6503 微 处 理 右 ， 主 要 控制 各 关节 的 实时 运 
动 。 编 程 时 可 以 VAL 语言 和 6503 汇编 语言 混合 编程 。 

VAL 语言 命令 简单 ， 清 晰 易 懂 ， 描 述 机 需 人 作业 动作 及 与 上 位 机 的 通信 均 较 方便 ， 实 
时 功能 强 ; 可 以 在 在 线 和 离线 两 种 状态 下 编程 ， 适 用 于 多 种 计算 机 控制 的 机 器 人 ; 能 够 迅速 
地 计算 出 不 同 坐标 系 下 复杂 运动 的 连续 轨迹 ， 能 连续 生成 机 器 人 的 控制 信号 ， 可 以 与 操作 者 
交互 地 在 线 修 改 程序 和 生成 程序 ; VAL 语言 包含 有 一 些 子 程序 库 ， 通 过 调用 各 种 不 同 的 子 
程序 可 很 快 组 合成 复杂 操作 控制 ; 能 与 外 部 存储 融 进 行 快 速 数 据 传输 ， 以 保存 程序 和 数据 。 

VAL 语言 系统 包括 文本 编辑 、 系 统 命令 和 编程 语言 三 个 部 分 。 

在 文本 编辑 状态 下 可 以 通过 键盘 输入 文本 程序 ， 也 可 通过 示 教 盒 在 示 教 方式 下 输入 程 
序 。 在 输入 过 程 中 可 修改 、 编 辑 、 生 成 程序 ， 最 后 保存 到 存储 器 中 。 在 此 状态 下 也 可 以 调用 
已 存在 的 程序 。 

系统 命令 包括 位 置 定义 、 程 序 和 数据 列表 、 程 序 和 数据 存储 、 系 统 状 态 设 置 和 控制 、 系 
统 开 关 控 制 、 系 统 诊断 和 修改 。 
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编程 语言 把 一 条 条 程序 语句 转换 执行 。 

(二 ) SIGLA 语言 

SIGLA 是 一 种 仅 用 于 直角 坐标 系 SIGMA 装配 型 机 项 人 运动 控制 时 的 一 种 编程 语言 ， 是 
20 世纪 70 年 代 后 期 由 意大利 Olivetti 公司 研制 的 一 种 简单 的 非 文本 语言 。 

这 种 语言 主要 用 于 装配 任务 的 控制 ， 它 可 以 把 装配 任务 划分 为 一 些 装 配子 任务 ， 如 取 旋 
具 ， 在 螺钉 上 料 副 上 取 螺 条 A、 搬 运 螺钉 A、 定 位 螺钉 A、 装 和 人 螺钉 A、 紧 固 螺 和 钉 等 。 编 程 
时 预先 编制 子 程序 ， 然 后 用 子 程序 调用 的 方式 来 完成 。 

(三 ) IML 语言 

IML 也 是 一 种 着 眼 于 末端 执行 颖 的 动作 级 语言 ， 由 日 本 九州 大 学 开发 而 成 。IML 语言 的 
特点 是 编程 简单 ， 能 人 机 对 话 ， 适 合 于 现场 操作 ， 许 多 复杂 动作 可 由 简单 的 指令 来 实现 ， 吻 
被 操作 者 掌握 。 

IML 用 直角 坐标 系 描述 机 器 人 和 目标 物 的 位 置 和 姿态 。 坐 标 系 分 两 种 ， 一 种 是 机 座 坐 标 
系 ， 一 种 是 固 连 在 机 器 人 作业 空间 上 的 工作 坐标 系 。 语 言 以 指令 形式 编程 ， 可 以 表示 机 器 人 
的 工作 点 、 运 动 轨迹 、 目 标 物 的 位 置 及 姿态 等 信息 ， 从 而 可 以 直接 编程 。 往 返 作 业 可 不 用 循 
环 语句 描述 ， 示 教 的 轨迹 能 定义 成 指令 插 到 语句 中 ， 还 能 完成 某 些 力 的 施加 。 

IML 语言 的 主要 指令 有 : 运动 指令 MOVE 、 速 度 指 令 SPEED 、 停 止 指 令 STOP、 手 指 开 
合 指令 OPEN 及 CLOSE 、 坐 标 系 定 义 指 令 COORD 、 轨 迹 定 义 命 令 TRAJ、 位 置 定义 命令 
HERE 、 程 序 控制 指令 IF…THEN 、FOR EACH 语句 、CASE 语句 及 DEFINE 等 。 

(四 ) AL 语言 

AL 语言 是 20 世纪 70 年 代 中 期 美国 斯 坦 福 大 学 人 工 智能 研究 所 开发 研制 的 一 种 机 需 人 
语言 ， 它 是 在 WAVE 的 基础 上 开发 出 来 的 ， 也 是 一 种 动作 级 编程 语言 ， 但 兼 有 对 象 级 编程 
语言 的 某 些 特征 ， 适 用 于 装配 作业 。 它 的 结构 及 特点 类 似 于 PASCAL 语言 ， 可 以 编译 成 机 器 
语言 在 实时 控制 机 上 运行 ， 具有 实时 编译 语言 的 结构 和 特征 ， 如 可 以 同步 操作 、 条 件 操作 
等 。AL 语言 设计 的 原始 目的 是 用 于 具有 传 感 硕 信息 反馈 的 多 台 机 器 人 或 机 械 手 的 并 行 或 协 
调控 制 编程 。 

运行 AL 语言 的 系统 硬件 环境 包括 主 、 从 两 级 计算 机 控制 ， 主 机 内 的 管理 器 负责 管理 协 
调 各 部 分 的 工作 ， 对 机 器 人 的 动作 进行 规划 ; 编译 天 负责 对 AL 语言 的 指令 进行 编译 并 检查 
程序 ; 实时 接口 负责 主 、 从 机 之 间 的 接口 连接 ， 闭 载 器 负责 分 配 程 序 。 从 机 接收 主机 发 出 的 
动作 规划 命令 ， 进 行 轨 人 迹 及 关节 参数 的 实时 计算 ， 最 后 对 机 器 人 发 出 具体 的 动作 指令 。 
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机 各 人 编程 技术 已 经 成 为 机 副 人 技术 向 稼 能 化 发 展 的 关键 技术 之 一 。 尤 其 令 人 瞩目 的 是 
机 带 人 离线 编程 ( Off-line Programming) 系统 。 离 线 编程 可 以 帮助 工程 技术 人 员 远 程 操 作 解 
决 现场 问题 等 。 


一 、 离 线 编程 的 特点 和 主要 内 容 
时 期 的 机 器 人 主要 用 于 大 批量 生产 ， 如 自动 线 上 的 点 焊 、 喷 涂 等 操作 ， 因 为 编程 所 花费 











第 “有 工业 机 器 人 高 线 编程 及 仿真 “人 


的 时 间 相 对 较 少 ， 示 教 编程 可 以 满足 这 些 机 需 人 作业 的 要 求 。 随 春 机 需 人 应 用 范围 的 扩大 和 
所 完成 任务 复杂 程度 的 提高 ， 在 中 、 小 批量 生产 中 ， 用 示 教 方式 编程 就 很 难 满足 要 求 。 在 
CADZCAM 机 需 人 一 体 化 系统 中 ， 由 于 机 项 人 工作 环境 的 复杂 性 ， 对 机 堪 人 及 其 工作 环境 万 
至 生产 过 程 的 计算 机 仿真 必 不 可 少 。 机 融 人 仿真 系统 的 任务 就 是 在 不 接触 实际 机 帮 人 及 其 工 
作 环 境 的 情况 下 ， 通 过 图 形 技术 ， 提 供 一 个 和 机 做 人 进行 交互 作用 的 虚拟 环境 。 

机 大 人 离线 编程 系统 是 机 夫人 编程 语言 的 拓 广 ， 它 利用 计算 机 图 形 学 的 成 有 末 ， 建 立 起 机 
船 人 及 其 工作 环境 的 模型 ， 再 利用 一 些 规 划算 法 ， 通 过 对 图 形 的 控制 和 操作 ， 在 离线 的 情况 
下 进行 轨迹 规划 。 机 答 人 离线 编程 系统 已 经 被 证 明 是 一 个 有 力 的 工具 ， 用 以 增加 安全 性 ， 减 
少 机 需 人 非 工 作 时 间 和 降低 成 本 等 。 表 7-1 给 出 了 示 教 编程 和 离线 编程 两 种 方式 的 比较 。 

表 7-1 两 种 机 器 人 编程 的 比较 





















































示 教 编程 离线 编程 
需要 实际 机 器 人 系统 和 工作 环境 需要 机 器 模型 和 工作 环境 的 图 形 模型 
编程 时 机 器 人 停止 工作 编程 不 影响 机 器 人 工作 
在 实际 系统 上 试验 程序 通过 仿真 试验 程序 
编程 的 质量 取决 于 编程 者 的 经 验 可 用 CAD 方法 ， 进 行 最 佳 轨迹 规划 
很 难 实现 复杂 的 机 器 人 运动 轨迹 可 实现 复杂 运动 轨迹 的 编程 

(一 ) 离线 编程 的 优点 


与 在 线 示 教 编程 相 比 ， 离 线 编 程 系 统 具 有 如 下 优点 : 

1) 可 减少 机 右 人 非 工 作 时 间 ， 当 对 下 一 个 任务 进行 编程 时 ， 机 带 人 仍 可 在 生产 线 上 工 
作 。 

2) 使 编程 者 远离 危险 的 工作 环境 。 

3) 使 用 范围 广 ， 可 以 对 各 种 机 各 人 编程 。 

4) 便于 和 CADZCAM 系统 结合 ， 做 到 CADACAM/ 机 各 人 一 体 化 。 

5) 可 使 用 高 级 计算 机 编程 语言 对 复杂 任务 进行 编程 。 

6) 便于 修改 机 项 人 程序 。 

机 各 人 语言 系统 在 数据 结构 的 支持 下 ， 可 用 符号 描述 机 各 人 的 动作 ， 一些 机 带 人 语言 
具有 简单 的 环境 构 型 功能 。 但 由 于 目前 的 机 需 人 语言 都 是 动作 级 和 对 象 级 语言 ， 因 而 编程 工 
作 是 相当 元 长 繁重 的 。 高 水 平 的 任务 级 语言 系统 目前 还 在 人 研制 中 ， 任 务 级 语言 系统 除了 要 求 
更 加 复杂 的 机 釉 人 环境 模型 文 持 外 ， 还 需要 利用 人 工 智能 技术 ， 以 目 动 生成 控制 决策 和 产生 
运动 轨迹 。 因 此 可 把 离线 编程 系统 看 作 动 作 级 和 对 象 级 语言 图 形 方式 的 延伸 ， 是 把 动作 级 和 
对 象 级 语言 发 展 到 任务 级 语言 所 必须 经 过 的 阶段 。 从 这 点 来 看 ， 离 线 编程 系统 是 研制 任务 级 
编程 系统 很 重要 的 一 个 基础 。 

(二 ) 离线 编程 系统 的 主要 内 容 

离线 编程 系统 不 仪 是 机 融 人 实际 应 用 的 一 个 必要 手段 ， 也 是 开发 和 研究 任务 规划 的 有 力 
工具 。 通 过 离线 编程 可 建立 起 机 器 人 与 CAD/CAM 之 间 的 联系 。 设 计 离 线 编程 系统 应 考虑 以 
下 几 方 面 的 内 容 : 

1) 机 需 人 工作 过 程 的 知识 。 

2) 机 融 人 和 工作 环境 三 维 实体 模型 。 
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3) 机 硕 人 几何 学 、 运 动 学 和 动力 学 知识 。 

4) 基于 图 形 显示 和 能 够 进行 机 需 人 运动 图 形 仿真 的 关于 上 述 1)、2)、3) 的 软件 系 
统 。 

5) 轨迹 规划 和 检查 算法 ， 如 检查 机 各 人 关 市 超 限 、 检 测 碰 撞 、 规 划 机 各 人 在 工作 空间 
的 运动 轨迹 等 。 

6) 传 感 硕 的 接口 和 仿真 ， 以 利用 传 感 硕 的 信息 进行 决策 和 规划 。 

7) 通信 功能 ， 进 行 从 离线 编程 系统 所 生成 的 运动 代码 到 各 种 机 天 人 控制 柜 的 通信 。 

8) 用 户 接口 ， 提 供 有 效 的 人 机 界面 ， 便 于 人 工 干预 和 进行 系统 的 操作 。 

此 外 ， 由 于 离线 编程 系统 的 编程 是 采用 机 需 人 系统 的 图 形 模型 来 模拟 机 需 人 在 实际 环境 
中 的 工作 ， 因 此 ， 为 了 使 编程 结 末 能 很 好 地 符合 于 实际 人 情况， 系统 应 能 计算 仿真 模型 和 实际 
模型 之 间 的 误差 ， 并 尽量 减 小 这 一 误差 。 


二 、 机 器 人 离线 编程 系统 的 结构 


机 和 问 人 离线 编程 系统 结构 如 图 72 所 示 ， 它 主要 由 用 户 接 口 、 机 侣 人 系统 构 型 、 运 动 学 
计算 、 轨 迹 规划 、 动 力学 仿真 、 并 行 操作 、 传 感 瘟 仿真 、 通 信 接 口 和 误差 校正 九 部 分 组 成 。 


用 户 接口 (User Interface) 


机 器 人 编程 运动 学 自动 生成 机 器 人 运动 仿真 
数 
据 编辑 语法 运动 学 轨迹 几何 4 A 
| [了 了 了 了 也 
代码 生成 
通信 接口 [一 -一 一 % 控制 柜 机 器 人 


图 7-2 机 融 人 离线 编程 系统 结构 

















(一 ) 用 户 接口 

离线 编程 系统 的 一 个 关键 问题 是 能 否 方便 地 产生 机 带 人 编程 系统 的 环境 ,便于 人 机 交 
互 。 工 业 机 和 侣 人 一 般 提供 两 个 用 户 接 口 : 一 个 用 于 示 教 编程 ， 男 一 个 用 于 语言 编程 。 示 教 编 
程 可 以 用 示 教 盒 直 接 编制 机 融 人 程序 ; 语言 编程 则 是 用 机 各 人 语言 编制 程序 ， 使 机 各 人 完成 
给 定 的 任务 。 目 前 这 两 种 方式 已 广泛 地 应 用 于 工业 机 磊 人 。 

作为 机 各 人 语言 的 发 展 ， 离 线 编程 系统 把 机 各 人 语言 作为 用 户 接口 的 一 部 分 ， 用 机 副 人 
语言 对 机 船 人 运动 程序 进行 修改 和 编辑 。 用 户 接口 的 语言 部 分 具有 机 和 硕 人 语言 类 似 的 功能 ， 
因此 在 离线 编程 系统 中 需要 仔细 设计 。 

男 外 用 户 接 口 的 一 个 重要 部 分 是 对 机 右 人 系统 进行 图 形 编辑 。 为 便于 操作 ， 用 户 接 口 一 
般 设 计 成 交互 式 。 一 个 好 的 用 户 接 口 ， 可 帮助 用 户 方便 地 进行 整个 系统 的 构 型 和 编程 操作 。 
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(二 ) 机 器 人 系统 的 三 维 构 型 

目前 用 于 机 带 人 系统 的 构 型 主要 有 以 下 三 种 方式 : 结构 立体 几何 表示 ; 扫描 变换 表示 ; 
边界 表示 。 

机 釉 人 离线 编程 系统 的 核心 技术 是 机 需 人 及 其 工作 单元 的 图 形 措 述 。 构 造 工作 单元 中 的 
机 需 人 、 夹 具 、 零 件 和 工具 的 三 维 几 何 模型 ， 最 好 采用 零件 和 工具 的 CAD 模型 ， 直 接 从 
CAD 系统 获得 ， 使 CAD 数据 共享 。 正 因为 从 设计 到 制造 的 这 种 CAD 集成 越 来 越 急需 ， 所 以 
离线 编程 系统 应 包括 CAD 构 型 子 系统 或 把 离线 编程 系统 本 里 作为 CAD 系统 的 一 部 分 。 奋 把 
离线 编程 系统 作为 单独 的 系统 ， 则 必须 具有 适当 的 接口 来 实现 构 型 与 外 部 CAD 系统 的 转换 。 

(三 ) 运动 学 计算 

运动 学 计算 分 运动 学 正解 和 运动 学 反 解 两 部 分 。 正 解 是 给 出 机 带 人 运动 参数 和 关 市 变 
量 ,， 计算 机 各 人 末端 位 姿 ; 反 解 则 是 由 给 定 的 末端 位 姿 计 算 相 应 的 关节 变量 值 。 在 离线 编程 
系统 中 ， 应 具有 目 动 生成 运动 学 正解 和 反 解 的 功能 。 

就 运动 学 反 解 而 言 ， 离 线 编程 系统 与 机 天 人 控制 柜 的 联系 有 两 种 选择 : 一 是 用 离线 编程 
系统 代 具 机 各 人 控制 柜 的 逆 运 动 学 ， 将 机 带 人 关 方 坐标 值 通 信 给 控制 柜 ; 二 是 将 篆 卡 儿 坐 标 
值 输出 给 控制 柜 ， 由 控制 柜 提 供 的 逆 运 动 学 方程 求解 机 融 人 的 形态 。 

(四 ) 轨迹 规划 

离线 编程 系统 除了 对 机 需 人 静态 位 置 进行 运动 学 计算 外 ， 还 对 机 带 人 在 工作 空间 的 运动 
轨迹 进行 仿真 。 由 于 不 同 的 机 各 人 厂家 所 采用 的 轨迹 规划 算法 差别 很 大 ， 离 线 编程 系统 应 对 
机 个 人 控制 柜 中 所 采用 的 算法 进行 仿真 。 

机 和 侣 人 的 运动 轨迹 分 为 自由 移动 ( 仪 由 初始 状态 和 目标 状态 定义 ) 和 依赖 于 轨迹 的 约 
束 运动 两 种 类 型 。 约 束 运 动 受 到 路 径 约 束 ， 受 到 运动 学 和 动力 学 约束 ， 而 自由 移动 没有 约束 
条 件 。 

轨迹 规划 混 采用 轨迹 规划 算法 ， 如 关 市 空间 的 插 补 、 笛 卡 儿 空 间 的 插 补 计算 等 。 同 时 ， 
为 了 发 挥 离线 编程 系统 的 优点 ， 轨 迹 规 划 融 还 应 具备 可 达 空 间 的 计算 ， 磁 撞 的 检测 等 功能 。 

(五 ) 动力 学 仿真 

当 机 需 人 跟踪 期 望 的 运动 轨迹 时 ， 如 果 所 产生 的 误差 在 允许 范围 内 ， 则 离线 编程 系统 可 
以 只 从 运动 学 的 角度 进行 轨迹 规划 ， 而 不 考虑 机 带 人 的 动力 学 特性 。 但 是 ， 如 果 机 和 侣 人 工作 
在 高 速 和 重 人 负载 的 情况 下 ， 则 必须 考虑 动力 学 特性 ， 以 防止 产生 比较 大 的 误差 。 

快速 有 效 地 建立 动力 学 模型 是 机 个人 实时 控制 及 仿真 的 主要 任务 之 一 ， 从 计算 机 软件 设 
计 的 观点 看 ， 动 力学 模型 的 建立 可 分 为 数字 法 、 符 写法 和 解析 (数字 -符号 ) 法 三 类 。 

(六 ) 并 行 操作 

离线 编程 系统 应 能 对 多 个 装置 进行 仿真 。 并 行 操作 是 在 同一 时 刻 对 多 个 装置 工作 进行 仿 
真 的 技术 。 进 行 并 行 操作 ， 以 提供 对 不 同 装置 工作 过 程 进 行 仿真 的 环境 。 

在 执行 过 程 中 ， 首 先 对 每 一 装置 分 配 并 联 和 串联 存储 器 。 如 果 可 以 分 配 几 个 不 同 处 理 吉 
共 一 个 并 联 存储 大 ， 则 可 使 用 并 行 处 理 ， 和 否则 应 该 在 各 存储 带 中 交换 执行 情况 ， 并 控制 各 工 
作 闭 置 运动 程序 的 执行 时 间 。 由 于 一 些 装置 与 其 他 装置 是 串联 工作 的 ， 并 且 并 联 工 作 装置 也 
可 能 以 不 同 的 采样 周期 工作 ， 因 此 稼 需 使 用 装置 检查 肯 ， 以 便 对 各 运动 朔 置 工作 进行 仿真 。 

(七 ) 传感器 仿真 

在 离线 编程 系统 中 ， 对 传 感 紫 进行 构 型 以 及 能 对 装 有 传 感 带 的 机 带 人 的 误差 校正 进行 仿 
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真是 很 重要 的 。 传 感 器 主要 分 局 部 和 全 局 两 类 ， 局 部 传感器 有 力 觉 、 触 党 和 接近 觉 等 传 感 
中， 全 局 传感器 有 视觉 等 传感器 。 传 感 器 功能 可 以 通过 几何 图 形 仿真 获取 信息 。 

传感器 的 仿真 主要 涉及 几何 模型 间 干 涉 (相交 ) 检验 问题 。 力 觉 传感器 的 仿真 比 触觉 
和 接近 觉 要 复杂 ， 它 除了 要 检验 力 传感器 的 几何 模型 和 物体 间 的 相交 外 ， 还 需 计 算出 两 者 相 
交 的 体积 ， 根 据 相 交 体 积 的 大 小 可 以 定量 地 表征 出 实际 力 传感器 所 测 力 和 数值 。 

( 八 ) 通信 接口 

在 离线 编程 系统 中 通信 接口 起 着 连接 软件 系统 和 机 器 人 控制 柜 的 作用 。 利 用 通信 接口 ， 
可 以 把 仿真 系统 所 生成 的 机 器 人 运动 程序 转换 成 机 器 人 控制 柜 可 以 接收 的 代码 。 

离线 编程 系统 实用 化 的 一 个 主要 问题 是 缺乏 标准 的 通信 接口 。 标 准 通 信 接 口 的 功能 是 可 
以 将 机 器 人 仿真 程序 转化 成 各 种 机 器 人 控制 柜 可 接收 的 格式 。 

为 了 解决 这 个 问题 ， 一 种 办 法 是 选择 一 种 较为 通用 的 机 器 人 语言 ， 然 后 通过 对 该 语言 加 
工 (后 置 处 理 ) ,使 其 转换 成 机 器 人 控制 柜 可 接收 的 语言 。 男 外 一 种 办 法 是 将 离线 编程 的 结 
果 转 换 成 机 器 人 可 接收 的 代码 ， 这 种 方法 需要 一 种 翻译 系统 ， 以 快速 生成 机 器 人 运动 程序 代 
公 。 

( 九 ) 误差 校正 

离线 编程 系统 中 的 仿真 模型 (理想 模型 ) 和 实际 机 器 人 模型 存在 误差 ， 产 生 误 差 的 原 
因 很 多 。 

目前 误差 校正 的 方法 主要 有 两 种 : 一 是 用 基准 点 方法 ， 即 在 工作 空间 内 选择 一 些 基 准点 
(一 般 不 少 于 三 点 ) ， 这 些 基准 点 具有 比较 高 的 位 置 精度 ， 由 离线 编程 系统 规划 使 机 器 人 运 
动 到 这 些 基准 点 ,通过 两 者 之 间 的 差异 形成 误差 补偿 孔 数 ; 二 是 利用 传感器 〈 力 觉 或 视觉 
等 ) 形成 反馈， 在 离线 编程 系统 所 提供 机 器 人 位 置 的 基础 上 ， 局 部 精确 定位 靠 传感器 来 完 
成 。 第 一 种 方法 主要 用 于 精度 要 求 不 太 高 的 场合 (如 喷涂 ) ， 第 二 种 方法 用 于 较 高 精度 的 场 
合 ( 如 装配 )。 
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工业 机 各 人 在 自动 化 生产 线 的 使 用 中 往往 以 工作 站 的 形式 出 现 。 所 谓 机 絮 人 工作 站 ， 即 
在 某 生 产 工 位 ， 由 一 人 台 或 多 台 机 侣 人 、 工 装 夹具 、 辅 助 设备 、 输 送 设 备 等 ， 共 同 完成 工件 的 
加 工 过程 。 因此， 要 保证 机 带 人 工作 站 的 正常 作业 ， 不 仪 要 对 机 旧 人 的 工作 原理 及 本 体 结构 
有 所 了 解 ， 同 时 还 应 对 机 规 人 外 围 设 备 及 其 与 机 敌人 之 间 的 关系 都 有 所 和 掌握。 


第 一 忆 、 弧 焊 机 总 人 工作 站 


弧 焊 机 右 人 工作 站 一 般 由 机 各 人 系统 、 焊 接 系 统 、 工 装 夹 具 ( 变 位 机 ) 系统 三 部 分 组 
成 。 当 有 多 台 机 胡 人 时 ， 还 应 有 中 央 控 制 系统 (可 编程 序 控制 带 PLC 控制 )。 弧 焊 多 用 于 汽 
车 零 部 件 的 焊接 生产 ， 在 摩托 车 、 工 程 机 械 、 农 业 机 械 以 及 家 电 产 品 中 也 有 应 用 。 


一 、 普 通 弧 焊 机 器 人 工作 站 


普通 弧 焊 机 需 人 工作 站 包括 机 天 人 系统 、 焊 接 系 统 、 工 装 夹具 及 安全 保护 闭 置 。 

机 各 人 系统 包括 机 妖 人 本 体 、 机 右 人 控制 柜 、 示 教 合 、 防 撞 传 感 带 、 机 大 人 底座 等 。 焊 
接 系 统 包 括 弧 焊 电 源 和 接口 、 送 丝 机 、 焊 丝 盘 支架 、 送 丝 软 管 、 焊 枪 、 防 撞 装 置 、 保 护 气管 
及 气体 铅 。 安 全 保护 设施 包括 围栏 、 安 全 门 和 排 烟 单 等， 必要 时 可 再 加 一 套 焊 枪 顺 嘴 清 理 及 
剪 丝 装置 。 工 作 站 的 特点 是 : 将 加 工 工件 放 在 工装 夹具 中 国定 好 ， 机 右 人 持 焊 枪 进 行 焊接 作 
业 ， 在 焊接 过 程 中 ， 工 件 固定 不 动 。 这 是 一 种 最 简单 经 济 的 弧 烛 机 帮 人 工作 站 。 


二 、 可 变 位 弧 焊 机 器 人 工作 站 


这 种 工作 站 与 普通 弧 焊 机 各 人 工作 站 不 同 的 是 ， 工 件 在 焊接 过 程 中 是 可 以 改变 位 置 和 姿 
态 的 ， 因 此 固定 工件 的 工装 夹具 由 变 位 机 来 蔡 代 ， 可 实现 工件 在 2 ~3 个 目 由 度 的 位 置 变 化 ， 
如 图 8-1 所 示 。 在 焊接 过 程 中 机 需 人 与 变 位 机 的 动作 要 相互 协调 ， 以 达到 最 好 的 焊接 效果 。 


三 、 多 台 机 器 人 工作 站 

多 台 机 需 人 工作 站 可 以 在 单 台 机 需 人 工作 站 基础 上 ， 增 加 一 人 台 搬 运 装配 机 融 人 ， 进 行 上 
下 料 搬运 操作 ， 还 可 以 将 符 焊 工件 组 装 起 来 ， 由 焊接 机 船 人 焊接 ， 也 可 以 让 搬运 机 秀 人 充当 
变 位 机 ， 夹 持 工 件 变 位 焊接 。 

多 台 机 各 人 弧 焊 工作 站 实例 : 
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图 8-1 ”两 轴 变 位 机 与 弧 焊 机 絮 人 组 成 的 工作 站 
1 一 机 器 人 本 体 2 一 焊 枪 3 一 机 器 人 控制 柜 4 一 工件 5 一 三 轴 变 位 机 6 一 焊接 电源 
7 一 送 丝 机 ”8 一 焊 枪 清理 装置 ”9 一 保护 气 瓶 ”10 一 焊丝 盘 支 架 11 一 送 丝 软 管 及 保护 气管 


(一 ) 工作 站 硬件 构成 

图 8-2 所 示 为 汽车 消 声 天 的 机 需 人 弧 焊 工作 站 ， 其 中 有 两 侣 机 般 人 ， 一 侣 为 日 本 安 川 公 
司 的 MOTOMAN 焊接 机 般 人 及 控制 柜 ， 忆 一 合 为 日 本 FANUC 搬运 、 装 配 机 规 人 及 控制 柜 ， 
在 两 人 台 机 融 人 之 间 为 变 位 机 ， 工 件 固 定 在 变 位 机 上 ， 变 位 机 可 以 做 水 平 转 劲 和 上 下 翻转 两 个 
自由 度 的 转动 。 除 了 机 融 人 ， 工 作 站 还 包括 焊接 系统 ， 中 央 控 制 侣 ， 机 各 人 控制 柜 ， 上 、 下 


料 合 ， 空 压 机 及 气 路 。 
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图 8-2 多 台 机 右 人 弧 焊 工作 站 
1 一 焊接 机 器 人 2 一 搬运 机 器 人 3 一 焊接 电源 4 一 焊接 机 器 人 控制 柜 5 一 控制 台 
6 一 变 位 机 7 一 搬运 机 絮 人 控制 柜 8 一 焊 枪 9 一 空 压 机 10 一 消 声 融 法 兰 盘 
11 一 消声器 外 简 12 一 消声器 内 简 13 一 加 工 好 的 工件 14 一 下 料 台 15 一 上 料 台 
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(二 ) 工作 过 程 

该 站 的 焊接 成 品 是 吉普 车 消 声 禹 ， 是 将 消 声 融 的 法 兰 盘 、 内 简 、 外 简 焊 接 在 一 起 。 工 作 
站 的 局 动 信号 通过 控制 人 台 上 触摸 屏 给 出 ， 搬 运 机 各 人 在 检测 到 工件 在 上 料 全 上 后 ， 首 先 将 消 
声带 的 法 兰 盘 搬运 到 变 位 机 上 由 夹具 洋基， 之 后 机 带 人 将 消 声 天 内 简 搬运 至 法 兰 盘 上 ， 再 将 
消 声 融 外 简 与 内 简装 配 在 一 起 ， 由 夹具 夹 紧 ， 搬 运 机 规 人 回 到 准备 位 置 。 焊 接 机 需 人 开始 焊 
接 第 一 道 焊 颖 一 一 内 简 与 外 简 间 的 焊 缝 ， 同 时 变 位 机 旋转 配合 焊接 。 第 一 道 焊 颖 完成 后 ， 扳 
运 机 需 人 将 焊 好 的 内 、 外 简 倒 置 放 到 法 兰 盘 上 ,夹具 夹 芭 后， 焊接 机 需 人 开始 焊接 外 简 与 内 
简 之 间 的 第 二 道 焊 颖 ， 同 时 变 位 机 旋转 。 之 后 ， 焊 接 机 和 右 人 开始 焊接 内 简 与 法 兰 盘 间 的 焊 
颖 ， 同 时 变 位 机 旋转 配合 焊接 。 第 三 道 焊 缝 完成 后 ,搬运 机 带 人 将 焊 好 的 成 品 搬 运 到 下 料 台 


放 好 ， 回 到 准备 位 置 。 


















































(三 ) PLC 控制 系统 构成 

该 系统 中 央 探 制 硕 为 西门 子 300 系 二 
列 PLC，CPU314 控制 缴 焊 机 顶 人 及 拔 
运 机 顺 人 的 动作 顺序 ， 两 台 机 需 人 的 运 
行情 况 和 故障 紧急 情况 都 会 实时 传送 到 
PLC 中 ， 同 样 ， 操 作 人 员 的 启动 、 停 止 
命令 及 紧急 停车 命令 ， 也 会 通过 PLC 传 
送 到 两 台 机 器 人 控制 柜 中 。 

PLC 的 系统 控制 结构 如 图 8-3 所 
全 。o 

(四 ) 工作 站 各 部 分 硬件 及 功能 

1. 陶 焊 系统 

弧 焊 系统 分 为 机 器 人 部 分 和 焊接 部 分 ， 如 图 84 所 示 。 









图 8-3 ” 弧 焊 搬运 机 需 人 工作 站 PLC 控制 结构 
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电动 机 电源 电缆 
图 84 弧 焊 系统 示意 图 


(1) 机 融 人 部 分 系统 中 机 带 人 采用 的 是 日 本 安 川 公司 的 MOTOMAN UP6 20kg 机 敌人， 


NN Tm A 


机 需 人 控制 顺 为 XRC， 该 控制 右 可 以 同时 控制 27 个 轴 进 行动 作 ， 其 中 包括 三 台 机 器 人 以 及 
九 个 外 部 轴 。 将 机 器 人 的 各 种 受 控 的 轴 按 轴 组 区 分 。 每 个 装置 的 轴 为 一 个 轴 组 。 一 人 台 机 器 人 
的 所 有 轴 ， 属 于 一 个 轴 组 ， 一 个 变 位 机 的 轴 ， 又 属于 另 一 个 轴 组 。 比 如 ， 一 人 台 控 制 锅 控制 了 
两 台 机 器 人 、 三 台 变 位 机 则 共有 五 个 轴 组 ， 分 别 为 机 器 人 1 轴 组 、 机 需 人 2 轴 组 、 变 位 机 1 
轴 组 、 变 位 机 2 轴 组 、 变 位 机 3 轴 组 。 

UP 机 器 人 轴 组 控制 方式 十 分 灵活 。 一 台 XRC 控制 器 可 以 实现 各 个 轴 组 的 多 种 控制 方 
3 

1) 同时 执行 几 个 程序 ， 每 个 程序 控制 不 同 的 轴 组 ， 各 自 完成 不 同 的 工作 任务 。 

2) 执行 一 个 程序 ， 该 程序 中 包括 儿 个 轴 组 ， 每 个 轴 组 单独 动作 ， 各自 完成 不 同 的 工 
全 

3) 执行 一 个 程序 ， 该 程序 中 包括 几 个 轴 组 ， 轴 组 之 间 的 动作 互相 协调 ， 实 现 特殊 的 动 
作 要 求 。 

具体 控制 方式 的 选用 ， 可 根据 实际 情况 来 确定 。 

在 该 站 中 变 位 机 作为 弧 焊 机 器 人 的 一 个 外 部 轴 由 XRC 控制 。 机 器 人 控制 器 XRC 中 ， 配 
备 了 各 种 通信 功能 ， 便 于 使 用 者 进行 系统 集成 。 这 些 可 用 通信 方式 中 有 以 太 网 、RS232C， 
还 有 用 于 现场 总 线 的 PROFIBUS-DP、INTERBUS-S、DEVICEBUS-S、M-NET 等 。 应 用 程序 可 
以 用 VC ++ 、VB 编制 。 

(2) 焊接 部 分 ”焊接 部 分 包括 焊接 电源 、 送 丝 右 、 送 丝 控 制 电 统 、 焊 丝 染 、 导 丝 统 、 
焊 枪 、 电 源 电 绕 、 保 护 气 等 。 

焊接 电源 通过 电源 电缆 分 别 连接 到 焊 枪 和 夹具 上 ， 提 供 焊接 电流 和 电压 。 焊 丝 从 焊丝 架 
经 过 导 丝 统 由 送 丝 厦 送 到 焊 枪 。 送 丝 硕 的 运转 是 由 焊接 电源 控制 的 ， 焊 接 电源 由 机 大 人 控制 
柜 控 制 ， 它 们 之 间 由 焊接 IF 电费 连接 ， 在 机 需 人 控制 程序 中 设 定 焊 接 参数 ， 并 发 出 焊接 起 
弧 、 烛 弧 指 令 。 焊 接 保护 气 通过 气 阀 门 和 软 管 送 到 焊 枪 。 

(3) 变 位 机 ” 消 声 絮 的 内 简 和 外 简 之 间 是 一 个 圆 形 的 焊 缝 ， 如 果 工 件 不 动 ， 机 器 人 焊 
接 的 角度 不 容易 保持 最 佳 状态 ， 因 此 ， 在 焊接 时 让 工件 旋转 而 机 器 人 的 姿态 不 需 做 很 大 改 
变 ， 就 可 让 工件 时 刻 处 于 最 佳 的 焊接 位 置 ， 保 证 焊接 质量 。 变 位 机 有 两 个 自由 度 的 旋转 ， 是 
作为 弧 焊 机 器 人 的 两 个 外 部 轴 由 焊接 机 器 人 控制 柜 控 制 的 ， 这 样 做 的 好 处 在 于 可 以 通过 示 教 
器 任意 定位 ， 并 达到 较 高 的 定位 精度 。 变 位 机 与 焊接 机 需 人 协调 运转 。 

2. 搬运 系统 

搬运 系统 由 上 、 下 料 台 ，FANUC M16iB 搬运 机 器 人 ，R-J3iB 机 闫 人 控制 柜 和 夹具 组 
成 。 

(1) 搬运 机 器 人 及 控制 柜 ” R-J3iB 机 器 人 控制 柜 与 周边 设备 的 连接 框图 如 图 8-$ 所 
示 。 

图 8-5 中 周边 设备 包括 上 、 下 料 台 上 安装 的 工件 感知 传 感 吉 ， 夹 具 松 开 、 夹 紧 位 置 传 感 
顺 信 和 号。 

(2) 上 、 下 料 台 上 、 下 料 台 都 装 有 工件 感知 传感器 ， 传 感 右 信和 号 连接 到 搬运 机 器 人 
控制 柜 ， 当 感知 有 工件 存在 时 ， 机 需 人 才 去 搬运 工件 。 

(3) 夹具 夹具 有 两 对 夹 爪 ,分 别 夹 持 法 兰 盘 和 消 声 带 外 位。 夹 扑 是 由 气 包 这 动 的 ， 
气 生 上 安装 有 活塞 位 置 限 位 开关 ， 来 检测 夹 爪 的 松 开 和 夹 紧 位 置 。 
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FANUC R-J3iB 控制 柜 结 检 一 
机 器 人 iB 控制 柜 结构 再 生 电 阴 


图 8-5 ”R-J3iB 机 器 人 控制 柜 与 周边 设备 的 连接 框图 
第 二 节点 焊 机 右 人 工作 站 


点 焊 机 船 人 在 汽车 焊 装 自动 化 生产 线 中 被 大 量 使 用 ， 用 于 焊接 和 车门、 底板 、 侧 于、 车 吴 
总 成 等 ， 如 图 86 、 图 8-7 所 示 。 点 焊 机 需 人 工作 站 在 目前 的 汽车 生产 线 中 多 为 多 台 机 器 人 
同时 作业 ， 生 产 线 两 侧 排 列 多 台 机 和 侣 人 ， 输 送 机 械 将 车 体 传送 到 不 同 工 位 后 ， 多 台 机 全 人 同 
时 焊接 ， 形 成 流水 化 作业 ， 大 大 提高 了 工作 效率 。 

汽车 焊 装 生产 线 可 以 按照 工 位 划分 成 多 个 工作 站 ， 每 个 工作 站 由 点 焊 机 需 人 、 机 和 需 人 控 
制 柜 、 工 朔 夹 具 、 焊 接 系 统 〈 包 括 焊 钳 、 焊 接 电 源 ) 、 气 动 系统 、 冷 却 系 统 组 成 ， 有 时 还 需 
要 快 换 装 置 ， 在 焊接 过 程 中 换 装 不 同 的 焊 钳 。 整 条 生产 线 还 需 中 央 控 制 右 〈PLC 或 计算 机 ) 
控制 。 

点 焊 机 带 人 工作 站 (图 8-8) 实例 : 


一 、 工 作 站 硬件 构成 


工作 站 是 选用 两 人 台 KUKA KR200/49 (200kg 负载 ， 最 大 工作 半径 为 2400mm) 机 天 人 作 
为 氢 运 机 需 人 和 焊接 机 天 人 使 用 ， 每 全 机 硕 人 由 一 个 机 需 人 控制 柜 、 一 人 台 日 本 小 原 南 京 公司 
生产 的 ST21 型 点 焊 控 制 带 〈Timer) 和 一 人 台 和 焊 钳 修 麻 肯 、 一 套 日 本 NITTA 公司 生产 的 目 动 
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工具 快 换 装置 、X 钳 和 C 钳 的 文 洪 保护 尝 各 一 套 、 一 台 冷 水 机 和 一 合 空气 压缩 机 、 一 人 台 系 统 
PLC 控制 柜 (内 有 SIMATIC 的 S7-300 系列 PLC) 、ET200S 分 布 式 VO、 一 人 台 带 有 触摸 屏 
(SIMATIC TP270-10) 的 操作 台 、 一 套 水 气 单元 系统 (内 法 有 电气 比例 阅 、 流 量 计 、 手 动 排 
水 阀 等 )、 上 料 侣 、 下 料 合 、 焊 接 夹 具 A、 焊 接 夹 具 B 及 安全 装置 (安全 门 、 光 如) 组 成 。 
图 8-9 所 示 为 点 焊 机 右 人 工作 台 设 备 布局 。 
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图 8-6 车 身 总 成 机 器 人 焊 装 生产 线 图 8-7 侧 围 的 焊接 机 器 人 工 位 (BMW) 


5 琅 作 壕 得 


两 台 机 器 人 可 以 独立 进行 操作 (KUKA A 系统 和 KUKA B 系统 ) ， 也 可 以 组 合 到 一 起 形 
成 一 个 系统 (KUKA AB 系统 ) ， 可 以 通过 主 操作 台 上 触摸 屏 的 主 画 面 来 选择 要 操作 的 系统 。 
三 个 独立 系统 的 工作 顺序 如 下 和 
(一 ) 独立 机 器 人 系统 A / 
在 夹具 A 上装 好 工件 (3 个 左右 ) ， 
通过 螺钉 手工 将 工件 夹 紧 ， 在 触摸 屏 上 
选择 操作 “KUKA A 系统 ”， 点 “ 确 
定 " 后 ，A 系统 开始 工作 , 机 器 人 A 引 史 
通过 自动 工具 快 换 装置 携带 X 型 焊 钳 “四 国 昨 和 
焊接 工件 ， 然 后 将 X 型 焊 氏 放下， 再， 国 时 
更 换 C 型 焊 钳 焊接 工件 ， 焊 接 完毕 后 ， 辆 :加 
将 C 理 焊 钳 放 到 焊 钳 支架 上 ， 人 工 将 
工件 取出 ， 工 件 焊 接 完毕 ， 一 个 工作 循 
环 结束 。 
(二 ) 独立 机 器 人 系统 了 
在 上 料 台 上 放 一 个 待 焊 车门 件 ， 在 触摸 屏 上 选择 操作 “KUKA B 系统 "， 点 “确定 
遇 后 ,B 系统 开始 工作 ， 机 器 人 卫 携 带 抓 具 将 车 门 从 上 料 台 取出 放 到 夹具 B 上 面 ， 放 完 车 站 
国 后 机 器 人 离开 夹具 B， 夹具 B 夹 紧 ， 等 待 10s 后 ,夹具 B 打开 ,机 器 人 B 携带 抓 具 将 车 门 从 








图 8-8 和 车门 点 焊 机 絮 人 工作 站 


夹具 B 上 取出 ， 然 后 将 车 门 放 到 下 料 台 上 ， 一 个 工作 循环 结 
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图 8-9 KUKA 点 焊 机 带 人 工作 站 设备 布局 
1 一 接近 开关 2 一 工件 检测 光栅 ”3 一 夹具 B 气 和 氏 4 一 气压 检测 开关 5 一 抓 具 气缸 
6 一 C 型 焊 钳 及 日 7 一 行程 开关 8 一 X 型 爆 钳 及 单 9 一 流量 计 10 一 电气 比例 阀 


(三 ) 整个 系统 (KUKA AB 系统 ) 

操作 者 在 上 料 合 上 放 一 个 车 门 ， 然 后 在 触摸 屏 上 选择 操作 “KUKA AB 系统 ”， 点 “ 确 
定 ” 后 ， 机 秀 人 B 携 市 抓 具 将 车 门 从 上 料 人 台 上 取出 放 到 夹具 B 上 ,夹具 B 夹 紧 ， 机 侣 人 A 
更 换 C 型 焊 钳 ， 在 夹具 B 上 焊接 车 门 ， 焊 接 完 毕 后 ,夹具 B 打开 ， 机 天 人 也 将 车 门 取出 放 
到 下 料 台 上 ， 在 机 如 人 B 工作 的 同时 ， 机 如 人 A 再 焊接 夹具 A 上 的 工件 ， 焊 接 完毕 后 ， 人 
工 取出 工件 。 在 这 个 工作 站 中 ， 搬 运 机 釉 人 携带 根据 车 门 形状 定制 的 气动 抓 ， 将 车 门 待 焊工 
件 从 上 、 下 料 全 搬运 到 工装 夹具 上 ， 和 车 门 被 夹具 固定 好 后 ， 和 气动 点 焊 机 髓 人 到 快 换 装置 处 安 
装 好 规定 型 号 的 点 焊 钳 ， 然 后 对 和 车门 进行 焊接 。 冷 却 水 系统 对 焊 钳 进行 冷却 ， 压 缩 空 气 系统 
为 搬运 机 帮 人 手 扑 和 工装 夹具 提供 压缩 空气 ,焊接 电源 提供 焊 钳 工作 的 电压 、 电 流 。 


三 、 工 作 站 控制 系统 结构 


机 磊 人 周边 设备 的 控制 及 车 门 的 装 夹 、 搬 运 和 焊接 过 程 的 控制 逻辑 由 配套 的 机 融 人 控制 
器 、 可 编程 序 控 制 磊 和 用 户 焊 接 示 教程 序 来 共同 完成 。 控 制 系统 框图 如 图 8-10 所 示 。 

PLC 控制 系统 是 西门 子 公 司 S7-300 系列 CPU313C-2DP 加 装 数字 量 输 入 /输出 模块 及 分 
布 式 VO 模块 ET200S 组 成 ，PLC 与 机 器 人 控制 柜 的 输入 /输出 连接 是 通过 机 需 人 控制 柜 内 
PROFIBUS-DP 通信 模板 CP5614 与 CPU 上 DP 总 线 接口 相连 的 。 
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图 8-10 ”点 焊 机 器 人 工作 站 PLC 控制 系统 框图 
四 、 工 作 站 各 部 分 硬件 及 功能 


(一 ) 机 器 人 控制 柜 KRC 

KUKA 机 各 人 控制 框图 如 图 8-11 所 示 。 

1. 计算 机 部 分 

计算 机 部 分 和 它 的 插 接 组 件 一 起 承担 机 右 人 的 所 有 控制 功能 。 这 些 功 能 包括 : 程序 的 建 
立 、 纠 错 、 存 档 及 管理 ,诊断 和 运行 文 持 ， 运 行 轨迹 设计 和 过 程控 制 ， 伺服 驱 动 控 制 ， 监 视 
程序 运行 ， 安 全 逻辑 电路 ， 与 外 部 单元 的 通信 联系 。 

(1) 奔腾 主机 、 软 盘 驱 动 锅 、 光 盘 了 驱动器、 显示 器 ”奔腾 处 理 需 为 每 台电 动机 (每 根 
轴 ) 计算 一 个 新 的 位 置 值 ， 各 位 置 值 通过 MFC 卡 传递 到 DSEAT 卡 ，DSEAT 卡 是 第 二 个 处 
理 带 ， 进 行 位 置 、 转 速 调 厄 及 换 癌 整流 。 

(2) KUKA 示 教 编程 各 ”编辑 机 器 人 程序 ， 用 空间 鼠标 代替 键盘 操纵 机 锅 人 的 运动 轨 
迹 ， 监 视 机 器 人 的 程序 执行 情况 。 

(3) 多 功能 卡 ( MFC) 连接 示 教 编程 器 ”有 系统 和 用 户 的 输入 /输出 端 ， 以 及 一 个 以 太 
网 控制 舌 、DeviceNet/CAN Bus 接口 ， 还 可 以 接 两 块 DSEAT 插件 板 。 
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图 8-11 KUKA 机 带 人 控制 框图 


(4) 数字 式 伺服 电子 电路 ( DSEAT) ”该 组 件 的 作用 是 可 对 最 多 八 个 轴 的 电动 机 位 置 、 
转速 进行 效 字 调节 ， 并 且 将 电流 设 定 值 传递 给 伺服 驱动 模块 。 旋 转变 压 带 数字 转换 般 的 信和 号 
及 伺服 驱动 模块 的 错误 和 状态 信息 也 由 该 组 件 处 理 ， 与 MFC 连接 得 到 主机 传 来 的 位 置 值 。 

(5) SIMATIC 通信 模板 CP5614 ”该 模板 的 作用 是 将 机 个 人 控制 柜 通 过 PROFIBUS-DP 网 
络 连 接 到 系统 控制 带 PLC， 在 两 者 之 间 进 行 双向 信息 交换 。 

(6) 旋转 变 压 带 数 字 转 换 锅 (RDW) ” 它 的 作用 是 为 旋转 变 压 带 供电 、 将 旋转 变 压 楷 
检测 到 的 轴 转 角 位 置 电压 值 转换 为 数字 量 (R-D 转换 ) 、 监 视 旋 转变 压 表 的 断路 情况 和 电动 
机 温度 、 通 过 串 行 接口 与 DSEAT 进行 数据 交换 。 

2. 伺服 模块 PM6-600 

该 模块 是 驱动 部 分 的 电源 ， 也 是 低压 供电 电源 ， 是 六 个 机 需 人 轴 的 伺服 放大 希 ， 同 时 也 
是 制 动 开 天， 带电 动机 电流 的 监视 和 短路 保护 法 置 ， 也 同时 可 监视 散热 体 、 空 气 、 镇 流 电 阻 
和 风 遍 的 温度 。 有 连接 DSEAT 的 接口 。 输 出 极 配 有 绝缘 栅 双 极 型 晶体 管 (IGBT)。 

(二 ) 西门 子 PLC 

西门 子 PLC 是 工作 站 的 中 央 控 制 项 ， 工 作 站 中 各 个 设备 的 运行 都 由 PLC 统一 控制 。 系 
统 中 采用 的 S7-300 系列 PLC 带 有 DP 接口 ，PLC 与 分 布 式 WO 模块 ET200S、 机 釉 人 A 和 机 
信人 B 控制 柜 之 间 都 是 通过 PROFIBUS-DP 连接 。PLC 也 带 有 扩展 0 模块 ， 连 接 现场 其 他 
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设备 的 控制 信和 号。 操作 箱 上 有 西门 子 触摸 屏 ， 用 来 显示 工作 站 状态 及 控制 系统 运行 模式 选择 
的 操作 ， 触 摸 屏 与 PLC 之 间 通 过 MPI 接口 连接 。 

(三 ) 修 磨 器 

修 磨 器 的 作用 是 对 烛 钳 电极 头 进行 清洁 ， 电 极 头 经 过 一 段 时 间 的 使 用 ,会 由 于 火花 的 作 
用 出 现 氧 化 现象 ， 影 响 焊接 质量 。 修 磨 器 由 电动 机 带动 进行 修 磨 ， 电 动机 正 转 一 段 时 间 后 反 
转 ， 电 动机 转动 的 同时 打开 气 嘴 吹 气 ， 去 挥 修 磨 下 来 的 金属 悄 。 

(四 ) 工具 快 换 装 置 1 

工具 快 换 装置 (图 8-12) 包括 一 个 机 器 
人 侧 ， 安 装 在 机 器 人 手臂 上 ， 和 一 个 工具 侧 ， 
安装 在 末端 执行 占 上 ， 如 焊 钳 或 抓 手 。 工 具 
快 换 装 置 能 够 让 不 同 的 介质 ， 例 如 气体 、 电 
信和 号、 液体 、 视 频 、 超 声 等 从 机 器 人 手臂 连 
通 到 末端 执行 器 。 人 气动 爆 钳 开 闭 的 行程 开关 
信号 就 是 通过 快 换 装置 传递 给 PLC 的 。 快 换 
装置 本 身 也 有 锁 紧 、 解 锁 、 接 合 三 个 接近 开 区 十 
关 信和 号 传递 给 机 器 人 。 图 8-12 工具 快 换 站 车 

(五 ) 焊接 控制 器 

控制 焊接 电流 、 电 压 的 大 小 和 时 间 周 期 ， 可 根据 所 焊接 材质 设 定 焊接 参数 。 焊 接 控制 器 
的 报警 信号 和 焊 点 结束 信和 号 传送 到 PLC， 焊 接 控制 继电器 信号 通过 KUKA 机 器 人 以 及 工具 快 
换 装 置 接 到 X 型 焊 钳 (或 C 型 焊 钳 ) 的 变压器 上 。 

(六 ) C 型 及 X 型 焊 钳 及 钳 罩 

两 种 焊 钳 分 别 保 存在 钳 单 中， 焊接 时 机 器 人 从 错 罩 中 通过 工具 快 换 装 置 与 焊 钳 连接 ， 两 
个 钳 香 分 别 由 两 个 气 包 控制 单 的 开启 和 闭合 ， 并 通过 接近 开关 传递 气 拭 的 位 置信 号 到 PLC ， 
每 个 置 中 还 有 一 个 检测 焊 钳 是 否 在 罩 内 的 传感器 ， 将 信号 传递 到 PLC。 

(七 ) ET200S 

ET200S 是 西门 子 PLC 的 分 布 式 IO 模块 ， 它 将 一 些 现场 的 170 信和 号 通过 PROFIBUS 线 
连接 到 PLC 上 。 在 该 站 中 ， 焊 钳 的 水 气 控制 信号 及 夹具 B 的 夹 紧 、 松 开 控 制 以 及 到 位 信号 
就 是 通过 ET200S 连接 到 PLC 上 。 

( 八 ) 机 器 人 B 抓 具 

机 器 人 B 负责 搬运 车 门 ， 其 抓 具 是 按照 车 门 的 形状 设计 的 ， 抓 具 的 三 个 手 爪 由 三 个 气 
氏 控 制 夹 紧 和 松 开 ， 每 个 气 氏 有 两 个 接近 开关 检测 气缸 活塞 的 位 置 。 抓 具 上 还 有 一 个 限 位 开 
关 检 测 工 件 是 否 被 抓 住 。 

( 九 ) 上 料 台 及 夹具 了 B 

上 料 台 及 夹具 B 有 着 类 似 的 结构 ， 因 为 它们 承载 的 工件 都 是 相同 的 车 门 ， 只 是 夹具 B 
有 夹 紧 气 饶 而 上 料 台 没有 。 在 上 料 台 及 夹具 B 上 都 有 两 个 用 来 检测 工件 是 否 存在 的 接近 开 
关 ， 只 有 两 个 接近 开关 都 发 出 有 工件 信号 时 ， 才 认为 工件 在 上 料 台 或 夹具 B 上。 夹具 BL 上 
有 四 个 双 作 用 气 氏 ， 每 个 气 氏 有 两 个 行程 开关 检测 气缸 活塞 的 位 置 。 上 料 台 及 夹具 B 上 都 
有 定位 销 ， 固 定 车 门 的 位 置 不 出 现 偏差 。 















































(十 ) 安全 设备 


在 工作 站 的 A 区 和 B 区 都 有 一 个 安全 门 和 一 个 安全 光 认 ， 安 全 光 间 安装 在 上 料 台 前 ， 
在 有 人 操作 上 料 时 ， 安 全 光 送 发 出 信号 阻止 机 天 人 运行 。 同 样 ， 当 安全 门 打开 时 ， 也 禁止 机 
船 人 运行 。 三 色 工 作 灯 指示 工作 站 的 运行 情况 。 


第 三 节 ” 深 边 机 强人 工作 站 


机 带 人 深 边 技术 是 近年 来 产生 并 得 到 迅速 发 展 的 一 项 车 门 新 工艺 ， 传 统 的 折 边 工艺 是 用 
液压 机 配 一 套 折 边 模具 ， 这 种 方式 最 大 的 优点 是 生产 率 高 ， 工 件 质 量 稳 定 ， 类 似 于 冲压 工艺 
但 又 有 区 别 ， 缺 后 是 难以 实现 柔性 化 生产 ,设备 维护 成 本 高 ， 作 业 面 积 大 。 机 各 人 和 车门 深 边 
技术 是 目前 汽车 制造 业 的 一 项 新 型 技术 ， 工 作 站 的 功能 是 由 机 人 右 人 完成 车 门 内 板 涂 胶 ( 密 
封 胺 和 减 振 胶 ) 和 和 车门 内 外 板 合 边 。 采 用 的 技术 达到 了 世界 先进 水 平 ， 可 以 实现 不 同 车 型 
的 柔性 化 生产 ， 并 且 深 边 工艺 较 液压 机 合 边 工艺 有 对 钢板 损伤 小 、 成 形 美观 、 生 产 率 高 、 工 
艺 调整 灵活 、 投 入 及 维护 成 本 低 、 作 业 面 积 小 、 适 应 性 强 等 优势 ， 机 需 人 滚 边 技术 是 今后 车 
门 、 机 装 成 形 技术 及 加 工 工艺 的 发 展 方 癌 。 

车 门 线 滚 边 机 船 人 工作 站 实例 : 


本 例 中 ， 滚 边 机 器 人 工作 站 是 车 门 总 成 生产 线 的 一 部 分 ， 车 门 线 滚 边 机 器 人 工作 站 的 控 
制 系统 采用 SIEMENS300 系列 PLC 作为 中 央 控 制 闫 ， 由 一 台 ABB 涂 胶 机 各 人 、 两 台 ABB 深 
边 机 融 人 、 英 格 索 兰 目 动 化 涂 胶 设备 及 旋转 转台 胎 具 等 组 成 ， 完 成 车 门 内 板 涂 胶 〈 密 封 胶 
和 减 震 胶 ) 和 和 车门 内 外 板 合 边 作业 。 涂 胶 机 各 人 同时 负责 车 门 内 外 板 的 搬运 。 

工作 站 人 硬件 主要 包括 三 大 部 分 : 滚 边 夹具 系统 、 深 轮 系统 、 机 天 人 及 其 控制 系统 。 

(一 ) 滚 边 夹具 系统 

深 边 夹具 系统 是 采用 机 带 人 深 边 技术 进行 柔性 化 生产 的 中 心 区 域 ， 通常 采 用 一 台 机 带 人 
依次 在 2 ~6 套 深 边 夹具 (图 8-13) 上 进行 柔性 化 深 边 作业 ， 所 有 深 边 夹具 布置 在 旋转 转台 
上 ， 实 现 用 一 侣 机 带 人 将 整 车 四 个 侧 车 门 及 前 后 盖 的 深 边 成 形 全 部 完成 。 
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图 8-13 ” 滚 边 夹具 149 
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(二 ) 滚轮 系统 

由 于 深 边 技术 本 刁 的 特点 ， 滚 边 过 程 一 般 分 为 2 ~4 次 顺序 完成 ， 因 此 深 轮 通常 设计 有 
45° 轮 、90° 轮 、 成 形 轮 、 专 用 特殊 轮 , 这 些 滚轮 可 以 组 合 在 一 个 滚轮 架 中 ， 也 可 以 分 解 在 两 
个 深 轮 架 上 ， 由 机 帮 人 抓 持 深 轮 执行 深 边 程序 ， 依 次 完成 整个 车 门 的 深 边 。 

图 8-14 所 示 为 机 如 人 深 边 作业 时 的 情景 。 机 各 人 在 涂 胶 之 前 ， 先 用 抓 具 将 车 门 内 板 、 
外 板 搬运 到 转 合 夹具 上 ， 然 后 换 滚 轮 进行 滚 边 作 业 ， 抓 具 和 滚轮 的 转换 是 通过 工具 快 换 装置 
完成 的 浮动 式 滚 边 头 如 图 8-15 所 示 。 








ET 和 .小 
图 8-14 ”机 器 人 滚 边 作 业 图 8-15 浮动 式 滚 边 头 


(三 ) 机 器 人 及 其 控制 系统 

该 系统 主要 用 于 控制 滚轮 的 运动 轨迹 ， 及 其 相关 系统 之 间 的 通信 。 滚 轮 运动 的 控制 通过 
编程 来 实现 ， 可 以 编制 不 同 程序 ， 根 据 不 同 状态 的 冲压 件 及 不 同 的 成 形 要 求 来 调用 ， 灵 活性 
高 ， 控 制 系 统 还 对 工具 快 换 装 置 、 深 边 夹具 、 深 轮 放 置 文 架 、 安 全 光栅 安全 门 、 焊 接 控制 
船 、 焊 枪 、 涂 胶 控 制 硕 等 系统 进行 控制 ， 协 调整 个 系统 中 每 个 单元 之 间 的 动作 及 顺序 ， 并 对 
整个 系统 进行 故障 报 管 。 
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1) 操作 工 取 前 门 内 板 总 成 、 前 门 外 板 装 入 上 料 人 台 ; 取 后 门 内 板 总 成 、 后 门 外 板 装 人 上 
料 人 台 ; 拍 下 完成 按钮 。 

2) 上 料 区 安全 门 目 动 关闭 后 ， 机 上 需 人 IRB01 抓 取 涂 胶 枪 ， 完成 前 门 、 后 门 外 板 涂 胶 
[ 共 两 种 腕 ， 前 门 外 板 涂 胶 长 度 〈3090 + 1820) mm， 后 门 外 板 涂 胶 长 度 〈3080 + 2100 ) 
mmj; 之 后 ， 机 甫 人 IRBO1 换取 抓 手 ， 抓 取 前 门 内 板 和 后 门 外 板 ， 移 至 滚 边 单元 将 后 门 外 
板 放 入 后 门 滚 边 胎 膜 中 ， 将 前 门 内 板 装 到 前 门 滚 边 的 压 具 上 ; 然后 抓 取 后 门 内 板 和 前 门 外 
板 ， 移 至 滚 边 单元 将 前 门 外 板 放 和 人 前 门 滚 边 胎 膜 中 ， 将 后 门 内 板 装 到 后 门 滚 边 的 压 具 上 。 

3) 机 硕 人 IRBO01 和 机 需 人 IRB02 更 换 深 边 涉 ， 同 时 前 门 压 具 、 后 门 压 具 将 内 板 压 入 深 
边 胎 膜 ， 然 后 固定 住 ; 机 融 人 IRBO01 和 机 需 人 IRB02 进行 深 边 操作 。 

4) 机 融 人 深 边 完成 以 后 ， 机 需 人 IRB02 更 换 抓 手 ， 抓 取 前 门 和 后 门 总 成 ; 然后 分 别 放 
到 前 门 和 后 门 的 Arplas 目 动 焊 夹 具 上 ， 焊 接 前 门 8 点、 后 门 8 点 补 焊 点 。 

5) 机 各 人 IRB03 抓 取 前 门 总 成 和 后 门 总 成 ， 到 切割 机 上 切割 百 片 ， 然 后 到 打 号 机 上 打 
产品 流水 号 ; 然后 机 需 人 IRB03 将 前 门 总 成 放 到 传送 市 输送 机 上 ， 传送 之 输送 机 将 工件 送 
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出 ; 机 大 人 IRB03 再 将 后 门 总 成 放 到 传送 带 输送 机 上 ， 传 送 带 输送 机 将 工件 送出 ; 操作 工 
取 走 前 门 总 成 、 后 门 总 成 效 入 到 匀 链 安装 夹具 上 ， 进 行 匀 链 的 安装 ， 之 后 将 市 贸 链 的 前 后 门 
总 成 放 到 料 箱 中 。 


三 、PLC 控制 系统 结构 





工作 站 控制 系统 (图 8-16) 是 西门 子 公 司 S7-300 系列 PLC CPU317-2DP 加 装 数字 量 输 
入 输出 模块 及 PROFIBUS-DP VO 模块， 以 实现 对 机 侣 人 控制 柜 、 阀 岛 、 夹 具 、 工 具 快 换 装 
置 、 涂 胶 控 制 旧 等 周边 设备 的 信息 交换 及 控制 的 系统 。PROFIBUS-DP 是 主要 的 信息 网 络 ， 
应 用 于 PLC 与 安全 继 电 带 、 机 各 人 控制 柜 以 及 机 人 禹 人 控制 柜 到 涂 肌 控 制 带 、 机 各 人 抓 具 、 
焊 钳 、 夹 具 等 ，DerviceNet 网 络 只 用 于 机 硕 人 控制 柜 之 间 ， 及 机 天 人 控制 柜 到 水 气 开关 之 间 ， 
从 而 使 滚轮 压力 得 到 控制 。 
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图 8-16 ”PLC 控制 系统 结构 
四 、 工 作 站 各 部 分 硬件 及 功能 


(一 ) 机 器 人 控制 器 IRCS 系列 

该 系统 采用 ABB 公司 及 B6600 机 硕 人 ， 机 硕 人 控制 硕 为 及 C5 系列 ， 机 硕 人 控制 硕 控 制 
框图 如 图 8-17 所 示 。 

从 图 8-17 中 可 以 看 到 ，IRC5 机 入 人 控制 着 是 由 两 部 分 组 成 的 ， 实 际 上 是 两 个 柜子 ， 一 
个 是 控制 柜 ， 男 一 个 是 驱动 柜 。 每 个 机 器 人 需要 一 个 驱动 柜 ， 最 多 四 个 机 器 人 共用 一 个 控制 
柜 ， 这 样 可 以 节省 空间 。 控 制 模 块 中 包括 多 处 理 器 系统 、 电 源 、 操 作 面 板 、 安 全 接口 ， 配 有 
两 条 以 太 网 通道 ， 一 条 用 于 局 域 网 ， 另 一 条 用 于 本 地 连接 ， 并 且 还 设 两 个 串 行 端口 ， 用 以 连 
接 传感器 、 输 入 输出 单元 、 其 他 生产 设备 及 打印 机 、 终 端 、 计 算 机 等 ， 实 现 点 对 点 通信 。 

驱动 模块 中 容纳 机 器 人 电源 、 整 流 硕 、 驱 劲 融 及 轴 计 算 机 和 张 劲 安全 接口 ， 轴 计算 机 用 
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图 8-17 ABB 公司 IRC5 机 带 人 控制 带 控 制 框图 









于 控制 机 各 人 电源 的 供电 。 

(二 ) 英 格 索 兰 自动 涂 胶 机 

在 该 站 中 使 用 了 两 僚 严 格 索 兰 自 动 涂 胶 系 统 ， 其 系统 构成 为 : 供 胶 系统 、PC 电气 控制 
系统 及 机 需 人 、 温 控 系 统 、 适 用 于 各 种 胶 和 流量 需求 的 涂 胶 喷头 以 及 管 路 附件 等 。 

供 胶 系统 采用 的 是 双 立 柱 气动 柱 塞 采 ， 每 个 柱 塞 条 由 气动 马达 、 润 清油 杯 、 压 盘 、 孙 
(Chop-check 和 到、 双 球 肥 或 四 球 条 ) 和 空 棚 检测 报警 装置 等 组 成 。 

该 站 中 根据 生产 特点 分 别 采 用 了 立柱 安 流 和 机 各 人 安装 两 种 方式 ， 并 构成 了 双 俏 切换 系 
统 ， 这 样 可 省 换 空 桶 时 间 ， 并 在 不 停产 状态 下 ， 进 行 设 备 维护 保养 。 

英 格 索 兰 自 动 涂 胶 系 统 功 能 

1) 温度 闭环 控制 ， 温 度 始终 保持 在 设 定 值 的 左右 。 

2) 双 组 分 胶 混 合 比例 控制 。 

3) 压力 和 流量 可 随机 替 人 指令 变化 而 动态 跟随 。 

4) 和 触摸屏 上 可 以 完成 各 种 参数 设置 ， 如 温度 、 压 力 和 流量 ， 故 障 诊 断 及 图 形 化 报警 信 





5) 生产 数据 记录 、 监 控 。 

6) 与 机 侣 人 之 间 的 通信 通过 DeviceNet 实现 。 

(三 ) 阿 普 拉 斯 (Aplas) 焊接 探 制 器 

Aplas 点 焊 技 术 的 特点 是 : 在 保证 焊 点 强度 达到 要 求 的 前 提 下 ， 尽 可 能 地 减少 每 个 焊 点 
的 能 量 输入 。Aplas 焊接 时 间 非 稼 短 《〈 实 际 上 仅 几 毫秒 ) ， 脉 冲 电流 很 大 ， 所 以 热 影响 区 显 
车 减 小 。 因 此 ， 使 用 Aplas 技术 焊接 的 工件 几乎 没有 任何 机 械 变形 。 

Aplas 焊 枪 能 够 保证 在 焊接 过 程 中 电极 始终 快速 跟踪 焊 点 的 演 (始终 保持 对 爆 点 的 压 
力 )。 焊 接 控 制 磊 中 狐 有 质量 检测 系统 ， 安 狐 的 是 焊接 能 量 控制 模块 ， 焊 接 过 程 中 ，CPU 始 
终 监 测 施加 在 焊 点 上 的 压力 ， 当 压力 达到 预 设 值 时 ， 品 闸 管 立 即 导 通 进行 焊接 。 质 量 监测 系 
统 还 安装 有 输入 /输出 模块 ， 位 置 传 感 副 信号 通过 这 些 模块 输入 质量 监测 系统 (QCS)， 质 量 
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监测 系统 (QCS) 通过 这 些 模块 输出 激活 信号 起 动 电磁 气动 冰 ， 驱 动 各 个 气动 单元 ， 用 户 可 
ee 

(四 ) 机 器 人 滑 台 

Ge ne 这 样 可 以 增加 机 大 人 
的 活动 范围 。 滑 台 的 移动 是 由 机 各 人 控制 紫 控 制 的 ， 滑 台 被 当 作 机 帮 人 的 外 部 轴 。 


第 四 厂 、 哎 涂 机 继 人 生产 线 


re Rd A i 稳定 、 高 效 的 特点 ， 适 用 于 生产 量 
大 、 产 品 型 号 多 、 表 面 形 状 不 规则 的 外 表面 喷涂 ,广泛 用 于 汽车 及 其 配件 、 家 电 、 仪 表 、 电 
器 ， 搞 交 等 工艺 生产 部 门 。 对 于 汽车 而 言 ， 贰 涂 机 器 f 人 生产 线 主要 应 用 于 车 身 外 表面 、 千 门 
内 表面 、 发 动机 舱 内 表面 、 行 李 箱 内 表面 、 前 照 灯 区 域 的 喷涂 作业 。 喷 涂 作 业 均 在 封闭 的 车 
间 《〈 喷 涂 房 ) 中 进行 ， 多 台 机 硕 人 同时 作业 。 机 种 人 的 喷涂 工作 主要 有 两 种 模式 : 一 种 是 
动 / 静 模式 ， 在 这 种 模式 下 ， 喷 涂 物 先 被 传送 到 喷涂 室 中 ， 在 喷涂 过 程 中 保持 静止 。 另 外 一 
种 是 流动 模式 ， 在 这 种 模式 下 ， 喷 涂 物 勺 速 通过 喷涂 室 。 在 劲 / 静 醒 式 时 机 带 人 可 以 移动 ， 
在 流动 醒 式 时 机 化 人 是 固定 不 动 的 。 

机 大 人 自动 喷涂 线 的 结构 根据 喷涂 对 象 的 产品 种 类 、 生 产 方式 、 输 送 形 式 、 生 产 纲领 及 
油漆 种 类 等 工艺 参数 确定 ， 并 根据 其 生产 规模 、 生 产 工艺 和 自动 化 程度 设置 系统 功能 ， 如 图 
8-18 所 不 。 
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图 8-18 ”汽车 机 喜人 喷涂 生产 线 流程 图 
1 一 输送 链 ”2 一 识别 器 3 一 白 车 身 4 一 输送 车 “5 一 起 动 装置 6 一 项 喷 机 
7 一 侧 喷 机 8 一 喷涂 机 器 人 ”9 一 喷枪 10 一 控制 台 11 一 控制 柜 12 一 同步 器 


一 、 自 动 识别 系统 


识别 系统 是 自动 化 生产 线 尤 其 是 多 品种 混流 生产 线 必须 具备 的 基本 单元 。 它 根据 不 同 夫 
件 的 形状 特点 进行 识别 ， 一 般 采 用 多 个 红外 线 光敏 开关 。 当 自动 线 上 被 喷涂 零件 通过 识别 站 
时 ， 将 识别 出 的 零件 型 号 进行 编组 排队 ， 并 通过 通信 送 给 总 控 系统 


二 、 同 步 系统 


同步 系统 一 般 用 于 连续 运行 的 通过 式 生 产 线 上 ， 使 机 项 人 、 喷 涂 机 工作 速度 与 输送 链 的 
速度 之 间 建 立 同步 协调 关系 ， 防 止 因 速度 快慢 差异 ee pa 
测 输送 链 速度 ， 并 向 机 融 人 和 总 控制 侣 发送 脉 冲 信号 ， 机 和 右 人 根据 链 速 信号 确定 再 现 程 序 的 
a 
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三 、 工 件 到 位 自动 检测 


咀 涂 机 各 人 开始 作业 的 启动 信号 由 工件 到 位 启动 检测 装置 给 出 。 此 信号 起 动 噶 涂 机 带 人 
的 喷涂 程序 。 如 果 没 有 工件 进入 噶 涂 作业 区 ， 哎 涂 机 带 人 则 处 于 等 竺 状态。 启动 信号 的 男 一 
个 作用 是 作为 总 控 系 统 对 工件 排队 中 减 去 一 个 工件 的 触发 信号 。 工 件 到 位 自动 检测 装置 一 般 
采用 红外 光电 开关 或 行程 开关 产生 局 动 信号 。 


四 、 机 器 人 与 自动 喷涂 机 


喷涂 机 需 人 多 采用 5 或 6 自由 度 关 节 式 结构 ,手臂 有 较 大 的 运动 空间 ， 并 可 做 复杂 的 轨 
迹 运动 ， 其 腕 部 一 般 有 2 ~3 个 自由 度 ， 运动 灵活 。 较 先进 的 喷涂 机 各 人 腕 部 采用 柔性 手 胶 ， 
既 可 向 各 个 方向 弯曲 ， 又 可 转动 ， 其 动作 类 似 人 的 手腕 ， 能 方便 地 通过 较 小 的 筷 伸 入 工件 内 
部 ， 喷 涂 其 内 表面 。 喷 涂 机 需 人 具有 动作 速度 快 、 防 爆 性 能 好 等 特点 ， 可 通过 手把手 示 教 或 
点 位 示 数 来 实现 示 教 。 

目 动 喷涂 机 由 机 械 本 体 和 电 控 装置 构成 ， 可 单机 运行 ， 也 可 多 机 或 与 机 表 人 一 起 在 同一 
总 控 下 联网 运行 。 可 用 于 喷漆 、 喷 胶 、 喷 塑 等 作业 。 

目 动 喷涂 机 可 以 有 侧 喷 、 顶 喷 、 仿 形 侧 喷 等 形式 。 图 8-18 中 的 生产 线 用 了 侧 嘎 和 项 顺 
两 种 形式 ， 分 别 对 车 厢 的 侧面 和 车 项 进行 喷涂 。 























五 、 总 控 系 统 








总 控 系 统 〈 图 8-19) 是 喷涂 自动 化 生产 线 的 核心 ， 控 制 所 有 设备 的 运行 ， 它 具备 以 下 





1) 全 线 自 动 局 动 、 停 止 和 联 锁 功 能 。 
2) 喷涂 机 需 人 作业 程序 的 自动 和 手动 排队 、 接 收 识别 信号 、 回 喷涂 机 需 人 发 送 程序 功 





3) 控制 目 动 输 漆 换 色 系统 功能 。 





机 器 人 控制 | | 自动 喷涂 机 | | 输 漆 和 自动 | | 自动 识别 | | 工件 到 位 自 同步 
控制 系统 换 色 系统 系统 动 检测 系统 
控制 控制 控制 深 别 到 位 链 束 


图 8-19 ”总 控 系统 框图 
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4) 故障 自动 诊断 功能 。 

5) 实时 工 况 显 示 功 能 。 

6) 单机 离线 〈 因 故障 ) 和 连 线 功 能 。 

7) 生产 管理 功能 〈 目 动 统计 产品 、 报 表 、 打 印 ) 。 


六 、 涂 料 自动 输送 与 换 色 系统 


为 保证 上 自动 喷涂 线 的 喷涂 质量 ， 涂 料 输送 系统 必须 采用 上 自动 搅拌 和 主管 循环 ， 使 输送 到 
各 工 位 读 具 上 的 涂料 黏度 保持 一 致 ” 对 于 多 色 种 喷涂 作业 ，。 喷 具 采 用 自动 换 色 系统 。 这 种 系 
统 包 括 上 自动 清洗 和 吹 干 功能 。 换 色 天 一 般 安 闭 在 离 喷 具 较 近 的 位 置 ， 这 样 ， 减 少 换 色 的 时 
间 ， 满 足 时 间 拍 有 要求。 同时 ， 清 洗 时 当 费 涂料 也 较 少 。 目 动 换 色 系 统 由 机 天 人 控制 ， 对 于 
被 喷 零 件 的 色 种 指令 ， 则 由 总 控 系 统 给 出 。 图 8-20 为 自动 换 色 系统 原理 图 。 
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图 8-20 ”自动 换 色 系统 原理 
七 、 自 动 输送 链 


自动 喷涂 线 上 输送 零 件 的 自动 输送 链 有 蚊 挂 链 和 地 面 链 两 种 。 悬 挂 链 分 普通 悬挂 链 和 推 
杆 式 悬挂 链 。 地 面 链 的 种 类 很 多 ， 有 人 台 车 输送 链 、 | 液 子 输 送 链 等 。 目前 ， 汽 车 
涂 装 广泛 采用 滑 构 式 地 面 链 ， 这 种 链 运 行 平稳 、 可 靠 性 好 ， 适 合 全 自动 和 高 光 渗 上 度 的 喷涂 线 
使 用 。 输 送 链 的 选择 取决 于 生产 规模 、 零 件 形状 、 重 量 和 # 巧 挂 链 和 输送 零件 
时 ， 挂 具 或 轨道 上 有 可 能 掉 异 物 ， 故 一 般 用 于 表面 距 涂 质量 要 求 不 高 和 工件 撒 面 喷涂 的 目 动 
线 。 而 对 大 型 且 表 面 喷涂 质量 要 求 较 高 的 零件 ， 都 采用 地 面 链 。 


八 、 机 器 人 喷涂 工作 站 实例 




















(一 ) 工作 站 硬件 构成 

本 工作 站 是 针对 汽车 前 照 灯 及 前 履 子 板 表面 进行 喷涂 而 设计 的 。 系 统 设备 主要 有 防爆 顺 
涂 机 融 人 〈IRB540-12) 及 其 控制 问 ， 输 调 漆 系 统 ， 工 件 和 输送 链 ， 操 作 台 ， 滑 人 台电 控 箱 ， 前 
疆 子 板 文 杂 ， 喷 涂 房 及 附件 。 
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(二 ) 工作 过 程 

如 图 8-21 所 示 ， 首 先 开 局 喷涂 房 排 风 系统 保证 工作 环境 处 在 负 压 状态 ， 人 工 放置 好 工 
件 (前 照 灯 灯 哩 放置 在 转台 上 ， 前 思 子 板 放 置 在 支架 上 )。 系 统 启动 后 ， 机 带 人 运行 到 等 待 
位 置 ， 滑 台 辐 前 运行 到 喷漆 位 ， 机 天 人 喷涂 第 一 个 灯草 ， 完 成 后 转台 右 转 ， 机 天 人 喷涂 第 二 
个 灯 午 ， 完 成 后 转台 右 转 ， 机 做 人 回 到 home (原点 ) 位 ， 滑 人 台 回 后 运行 到 上 下 料 位 ;机 天 
人 嘎 涂 左前 于 子 板 ， 完 成 后 机 融 人 喷涂 右前 性 子 板 ， 完 成 后 机 硕 人 回 到 home 位 。 


















前 双子 板 PE 喷涂 机 器 人 
操作 台 、 清 输 调 漆 系统 
台电 控 箱 
前 照 灯 向 是 机 器 人 控制 柜 
滑 台 


图 8-21 涂 装机 器 人 工作 
(三 ) 工作 站 控制 系统 结构 
喷涂 房 机 器 人 控制 系统 结构 如 图 8-22 所 示 。 
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图 8-22 ”喷涂 房 机 器 人 控制 系统 结 格 
(四 ) 工作 站 各 部 分 硬件 及 功能 
1. 机 器 人 控制 柜 人 RC 
本 系统 中 机 帮 人 控制 柜 控制 机 右 人 的 喷涂 运行 过 程 ， 输 调 漆 系统 的 工作 由 机 右 人 控制 柜 











控制 ， 操 作 人 台 发 出 的 运行 、 停 止 信 号 和 工件 输送 链 滑 台 、 转 合 的 位 置信 号 以 及 排 风 机 的 运行 


言 写 也 传送 到 KRC， 因 此 ，KRC 是 系统 的 中 央 控 制 硕 。 
2. 工业 机 器 人 
机 釉 人 选用 ABB IRB540-12 防爆 喷涂 机 需 人 。 
其 技术 参数 为 : 


1) 
2) 
3) 
4) 
5) 
6) 
1) 
8) 
9) 


厌 载 能 力 : 5kg。 

重复 定位 精度 : 0. 06mm。 

轴 数 6。 

旋转 : 300"， 最 大 转速 112%/s。 
垂直 臂 : 145°% ， 最 大 转速 112°/s。 
水 平 辟 : 95° ， 最 大 转速 112°/s。 
及 : 176。， 最 大 转速 360°/s。 
鞍 曲 : 176”"， 最 大 转速 360°/s。 
翻转 : 640。， 最 大 转速 700°/s。 


10) 控制 器 : S4Cplus。 

11) 本 体重 量 : 607kg。 

12) 安装 环境 温度 : 机 器 人 本 体 : 5 ~45%C。 
13) 防护 等 级 : 本 体 IP67， 控 制 絮 IP54 


该 型 号 的 机 人 人， 采用 独 有 的 Flexi Wrist 〈 和 性 手腕 ) 专利 技术 ， 极 大 地 便利 了 人 工 编 
程 操 作 〈 点 对 点 连续 路 径 ) 。 只 需 人 工 将 机 赫 人 移 至 各 个 目标 程序 位 置 ， 然 后 按 触发 钮 ， 系 


统 将 自动 编写 RAPID 程序 指令 。 
3. 输 调 漆 系统 


输 调 漆 系统 (图 8-223) 由 阳 膜 人 汞 、 涂 料 调 压 右 、 气 动 搅 拌 磁 、 背 压 阀 、 涂 料 桶 、 压 力 





隔膜 泵 
涂料 调 压 器 

背 压 闪 

涂料 软 管 
虹吸 组 件 气动 搅拌 器 





图 8-23 输 调 漆 系 统 





mn 


表 、 软 管 等 组 成 。 隔 膜 泵 把 涂料 从 桶 中 吸出 并 加 压 ， 经 过 涂料 调 压 磊 ， 使 涂料 压力 调整 到 顺 
涂 要 求 ， 供 给 喷枪 进行 喷涂 。 多 余 的 涂料 和 喷枪 停 喷 时 ， 涂 料 经 过 枪 下 三 通 及 软 管 和 背 压 闪 
流 回 到 涂料 桶 中 ， 背 压 天 的 功能 是 使 系统 中 有 供 喷涂 的 压力 和 使 涂料 流动 的 压 差 。 

4. 工件 输送 链 

如 图 8-24 所 示 ， 工 件 输送 链 分 下 层 滑 台 和 上 层 转 台 两 部 分 : 上 层 转台 托盘 直径 为 
400mm， 主 要 负责 种 动 两 个 尺寸 为 150mm x 240mm 的 前 照 灯 灯 章 ， 通 过 转台 内 部 的 涡轮 旋 
转 气缸 实现 正 负 180* 旋 转 ， 以 保证 喷涂 机 需 人 对 单独 一 件 工件 的 表面 均匀 喷涂 。 下 层 滑 台 
由 清 侣 文 架 及 滑 台 组 成 。 利 用 无 杆 气缸 的 直线 运动 把 工件 从 上 下 料 位 输送 到 喷漆 位 ， 待 工件 
喷 完 毯 后 ， 再 目 动 送 回 到 上 下 料 位 。 





工件 滑 台 


图 8-24 工件 输送 链 


5. 操作 台 、 消 台电 控 箱 

操作 人 台 上 的 系统 启动、 停止 按钮 都 传送 到 机 天 人 控制 柜 ， 再 由 机 需 人 控制 柜 控 制 滑 台 、 
转台 的 运行 。 

滑 台 是 由 气动 执行 机 构 驱 动 的 ， 通 过 电位 立 使 气动 阔 门 动作 ， 从 而 控制 涓 台 的 转动 和 滑 
动 。 滑 台 、 转 台 的 运行 速度 可 通过 调整 电磁 阀 、 涡 轮 旋转 气 氏 上 流量 阀门 的 开启 大 小 来 实 
he 








第 五 刷 _ 冲 压 机 中 人 生产 线 


在 汽车 和 车身 生产 中 ， 冲 压 生 产 上 自动 化 线 也 大 量 使 用 机 各 人 ， 在 冲压 机 之 间 传 递 工件 ， 大 
大 提高 了 和 生产率， 实现 了 冲压 生产 的 无 人 化 。 机 右 人 与 冲压 机 的 完美 配合 ， 也 成 为 车 号 车 间 
的 一 道 之 丽 风 景 。 

冲压 机 右 人 生产 线 实例 : 


一 、 和 生产线 硬件 结构 


本 例 冲 压 自 动 化 线 为 汽车 车 号 冲压 线 ， 由 五 侣 单 动 冲压 机 1400T (SEC) 和 另外 四 人 台 单 
动 冲压 机 600T (SE) 、 两 侣 拆 丈 小 车 、 对 中 台 、 出 料 传送 带 、 一 合 拆 夫 机 需 人 和 七 台 送 料 
机 器 人 组 成 ， 如 图 8-25 所 示 。 冲 压 生 产 线 实景 如 图 8-26 所 示 。 
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图 8 -25 吉 构 布局 





图 8-26 ”冲压 生产 线 实景 


-一 、 工作 过 才 程 


由 又 车 将 开卷 线 下 好 的 板 料 上 到 生产 线 首 端的 两 个 可 移动 拆 埃 小 车 上 。 板 料 由 一 台 装 有 
双料 检测 融 的 拆 式 机 俘 人 进行 拆 折 ， 然 后 放置 在 对 中 全 上 。 板 料 在 对 中 台 上 对 中 后 由 一 人 台 上 
料 机 各 人 抓 起 , 并 将 板 料 放 到 带 液 压 垫 的 1 号 冲压 机 1400T (SEC) 里 进行 冲压 之 后 , 由 两 
台 机 个 人 进行 下 料 、 板 料 翻转 、 上 料 的 操作 ， 将 板 料 从 1 号 压 机 传递 到 2 号 压 机 ， 后 面 的 3 
台 机 硕 人 完成 板 料 从 2 号 压 机 至 5 号 压 机 的 上 下 料 操作 ， 一 个 出 线 端 机 釉 人 将 已 冲压 好 的 零 
件 从 5 号 压 机 里 取出 ， 放 置 在 出 料 传 送 带 上 ， 出 料 传送 珊 将 零件 传送 到 操作 人 员 处 ， 由 后 者 
将 零件 放置 在 成 品 箱 里 


三 、 生 产 线 控制 系统 结构 


生产 线 的 整个 自动 化 系统 分 为 冲压 机 和 机 器 人 自动 化 两 大 部 分 。 

(一 ) 冲压 机 部 分 

冲压 机 按照 设备 的 组 成 一 般 可 分 为 上 横梁 、 滑 块 、 底 座 、 活 动工 作 台 、 液 压 站 和 冲压 机 
操作 面板 以 及 冲压 机 控制 柜 等 几 部 分 。 采 用 SIEMENS 公司 的 S7416-2DP PLC 作为 控制 系 
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统 ， 通 过 PROFIBUS 总 线 将 分 布 在 各 个 冲压 单元 的 分 布 式 WO、 编码 兹 、 变 频 右 、 直 流 调 速 
器 、MP370 人 机 界面 等 连接 起 来 。 

(二 ) 机 器 人 自动 化 部 分 

机 器 人 控制 系统 同样 采用 SIEMENS S7 416-2DP PLC 作为 控制 器 , 通过 PROFIBUS 总 线 
连接 管理 分 布 在 6 个 单元 的 ET200S、 变 频 帮 、MP370 人 机 界面 、 机 需 人 控制 柜 以 及 通过 
DPZDP 耦合 句 来 和 冲压 机 部 分 的 PLC 进行 数据 交换 。 冲 压 生 产 线 控制 系统 框图 如 图 8-27 所 
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图 8-27 冲压 生产 线 控制 系统 方 框图 


四 、 生 产 线 各 部 分 硬件 及 功能 


1) 上 料 拆 才 装 置 。 将 勇 切 堆 志 好 的 来 料 进行 目 动 拆 才 并 单 片 依次 送 入 首 全 冲压 机 。 
2) 压力 机 。 按 照 产品 的 冲压 工艺 由 4 ~6 人 台 单 体 压 力 机 排列 成 线 ， 并 将 钢 或 铝板 通过 
模具 冲压 成 形 。 


第 八 章 ”工业 机 器 人 工作 站 及 生产 线 A 





3) 尾 端 工艺 设备 。 由 人 工 或 目 动 化 朔 置 将 成 品 工件 从 最 后 一 个 工 位 取出 并 放置 在 传送 
"rs 

4) 机 佛 人 或 机 械 手 加 穿梭 小 车 式 输 送 机 构 。 负 责 工件 在 拆 过 一 冲压 机 一 传送 沉 之 间 的 
日 动 传送 。 


五 、 工 作 站 各 部 分 硬件 及 功能 


(一 ) 机 器 人 控制 柜 

在 每 个 机 各 人 S4CPlus 控制 系统 中 配置 DSQC352 单元 板 ， 使 机 船 人 控制 柜 成 为 PROFT- 
BUS-DP 从 站 ， 实 现 西 门 子 PLC 和 ABB 机 右 人 之 间 的 信息 交换 ， 机 帮 人 发 给 冲压 机 的 上 下 
料 确 认 、 机 器 人 在 冲压 机 范围 外 和 起 动 冲 压 机 冲压 等 信号 通过 总 控 PLC 传送 到 冲压 机 PLC。 
冲压 机 发 送 给 机 釉 人 的 下 料 人 允许、 零件 在 压 机 内 、 和 零件 已 冲压 等 信号 也 通过 总 控 PLC 传送 
到 机 各 人 控制 柜 。 

ABB S4CPlus 机 器 人 控制 器 具有 QuickMoveTM 功能 和 TrueMoveTM 功能 。QuickMoveTM 
功能 确保 至 少 有 一 个 驱动 电动 机 提供 最 大 转 矩 ， 这 使 得 机 各 人 各 轴 在 没有 轨迹 偏差 的 条 件 下 
可 以 实现 最 大 加 速度 或 减速 度 。TrueMoveTM 功能 提供 了 与 TCP 速度 无 关 的 最 佳 轨 迹 精 度 和 
可 徘 性 ， 对 于 关 市 式 机 絮 人 而 言 ， 其 轨迹 精度 最 高 ， 并 且 保 证 速度 恒定 。 

S4CPlus 具有 的 独特 动态 模型 前 馈 控 制 功能 ， 使 它 可 上 自行 进行 运动 优化 (QUICK- 
MOVE)。 通 过 前 僻 控制 ， 还 实现 了 外 部 轴 的 轨迹 精度 的 优化 。 速 度 和 精度 在 各 种 条 件 下 始 
终 保持 在 最 高 水 平 ， 见 表 8-1。 























表 8-1 S4CPlus 技术 参数 


















































参数 名 称 要 求 参数 名 称 要 求 
控制 轴 数 21 电源 电压 200 ~600V, 50/60Hz 
控制 原理 动态 模型 控制 柜 尺寸 SOmm x 800mm x 540mm 
完全 协调 控制 根据 用 户 需 要 的 管理 功能 ; RAPID 有 效 
12 轴 插 补 而 开放 的 机 器 语言 ; 过程 软件 、 应 用 软件 
自动 化 七 坐标 系 复合 链 程序 特点 程序 包 ; 镜像 功能 ; 软 伺服 功能 ; 第 四 轴 
转角 轨迹 概念 和 第 六 轴 的 无 限制 旋转 ; 轨迹 上 再 起 动 ; 
自动 异常 处 理 前 进 / 后 退 / 仿 真 等 待 和 输入 测试 
控制 硬件 多 处 理 器 系统 防护 等 级 IP54 
PCI 总 线 串 行 信 道 两 个 RS232 和 一 个 RS485 
ope 32MB DRAM 标 配 64MB， 最 大 128MB 网 络 两 个 以 太 网 接口 (100Mbit/s) 
年 储 器 
Flash-Disk 现场 总 线 CAN Interbus-S Profibus 
断 电 保护 20s UPS 集成 的 OptiMaster; 焊 颖 跟踪 ; 轮廓 跟 
视觉 系统 ee 
0 最 多 1024 路 信号 ，24V 直流 、120V 踩 ; 传送 带 跟 随 
字 输 入 /输出 | ，， ，， 
交流 或 继 电 关 离线 、 在 线 编程 、 仿 真 ， 可 在 PC 机 上 
模拟 输入 /输出 最 多 120 路 信和 县 ， + 上 10V、+ 上 20mA 运行 S4C Plus 软件 
会 出 面向 对 象 的 程序 设 1 
ee de 可 电路 板 上 有 LED 和 测试 点 ;诊断 软件 ; 
0 周作 复 步骤 ， 带 有 时 间 的 故 联 记 录 
共用 、 开 放 、 可 扩展 











mn 


(二 ) 机 器 人 端 拾 器 

机 大 人 的 末端 安装 有 端 拾 般 ， 用 来 抓 取 板 件 。 由 于 板 件 为 薄 壁 件 ， 一 般 采 用 真空 吸附 的 
方式 抓 取 ， 真 空 吸盘 布置 在 端 拾 侣 文 染 上 ， 吸 盘 数 量 及 其 布置 方式 依据 具体 的 板 件 而 定 。 气 
路 控制 系统 融 有 真空 度 检测 传 感 毅 ， 通 过 检测 吸盘 内 真空 度 判断 板 件 是 否 吸附 到 位 ， 搬 运 过 
程 中 板 件 是 否 掉 落 等 。 端 拾 需 的 结构 与 板 件 外 形 有 关 ， 因 此 不 同 的 板 件 与 不 同 的 工 位 均 需 要 
配置 不 同 的 端 拾 右 。 

近年 来 ， 为 了 克服 六 轴 机 人 右 人 搬运 过 程 中 板 件 
的 拌 动 以 及 进一步 提高 生产 这 ， 机 各 人 搬运 系统 开 
发 出 了 旋转 七 轴 和 端 拾 胡 自 动 更 换 技术 。 旋 转 七 轴 
技术 是 在 机 天 人 第 六 轴 上 加 装 一 个 伺服 控制 旋转 
臂 ， 实 现 工 件 在 上 下 工 位 压力 机 间 搬 运 过 程 中 的 平 
移 ， 避 免 了 以 往 工 件 因 180° 旋 转 而 产生 的 拌 动 与 
脱落 ， 便 于 机 硕 人 搬运 过 程 的 提速 〈 图 8-28 ) 。 端 
拾 侯 目 动 更 换 技术 是 在 全 自动 换 模 过 程 中 ， 机 秀 人 
控制 系统 根据 操作 人 员 输 入 的 模具 号 实现 : (D 原 端 
拾 需 在 旋转 台 上 的 自动 定 置 和 接头 自动 放松 ; 书 旋 
转台 180° 转 动 ， 原 端 拾 紫 转 出 工作 区 域 ， 新 端 拾 图 8-28 ”旋转 七 轴 机 融 人 搬运 系统 
带 转 入 工作 区 域 ; 机 融 人 与 新 端 拾 右 接头 自动 来 紧 ， 迅 速 回 到 工作 原点 待命 。 整 个 过 程 在 
全 目 动 换 模 过 程 中 完成 ， 从 而 大 大 缩短 了 非 生 产 工时 ， 提 高 了 整 线 的 生产 率 。 

(三 ) 冲压 机 

本 系统 冲压 机 为 德国 舒 勒 公司 产品 ， 冲 压 机 的 自动 控制 有 两 个 方面 ， 一 个 在 冲压 过 程 的 
控制 方面 ， 男 一 个 是 在 模具 更 换 的 控制 方面 。 冲 压 机 在 冲压 时 需要 对 压 机 滑 块 运动 位 置 进行 
检测 及 校对 ， 还 要 对 模具 内 禾 盖 件 是 否 到 位 、 安 全 光 希 、 压 力 机 总 气压 、 平 衡 生 及 平衡 垫 压 
力 、 油 压 等 进行 检测 。 检 测 参数 达到 标准 后 ， 冲 压 才 可 以 进行 。 因 此 冲压 机 PLC 要 与 气压 
传 感 融 、 油 压 传 感 融 、 位 置 传 感 融 输入 信号 连接 ， 控 制 滑 块 电动 机 的 运行 及 停止 。 

在 本 系统 中 模具 的 更 换 也 实现 了 全 自动 。 需 要 全 线 自 动 换 模 时 ,通过 MP370 页 面 上 的 
功能 ， 在 MP370 内 的 零件 表 中 选择 需要 生产 的 零件 号 ， 发 送 全 线 换 模 命 令 ， 生 产 线 即 开始 
自动 换 模 。 全 自动 换 模 系统 的 主要 功能 包括 : 山 平 衡器 与 气垫 压力 自动 调整 ;他 装 模 高 度 、 
气垫 行程 自动 调整 ，(3) 模 具 自 动 来 紧 ， 放 松 ; 9 高 速 移动 工作 合 自 动 开 进 开 出 ; () 机 带 人 的 
参数 、 压 机 的 工艺 参数 全 部 目 动 调整 和 更 换 。 















































工业 机 器 人 的 出 现 大 大 减少 了 人 的 重复 性 劳动 强度 ， 也 减少 了 产品 加 工 过 程 中 人 为 因素 











对 于 产品 质量 的 影响 。 然 而 自动 化 率 的 提高 伴随 春 设 备 复杂 性 和 总 量 的 提高 ， 意 味 着 整个 生 
产 系统 的 综合 生产 效率 (OFE) 受 设备 维护 保养 工作 影 啊 越 来 越 大 ， 需 要 做 的 设备 维护 工 
作 也 就 越 来 越 多 。 因 此 需要 通过 一 整套 设备 维护 管理 体系 来 保证 设备 工 况 ， 尽 可 能 减少 设备 
停机 、 和 零件 过 度 损 耗 等 当 费 行为 ， 实 现 精益 生产 〈Lean Production) 的 最 终 目 标 。 

目前 设备 维护 部 门 的 工作 体系 由 原来 的 “以 修 为 主 ” 向 着 “科学 维护 ， 尺 量 减少 维修 
工作 ”的 方向 发 展 。 简 而 言 之 为 “两 维护 ， 两 维修 ， 一 改进 ”， 如 图 9-1 所 示 。 其 中 ， 将 维 
护 作 为 工作 的 重 中 之 重 。 在 现实 工作 中 ， 紧 急 维 修 、 修 正 性 维修 是 不 可 避免 的 ， 但 是 通过 持 
续 改 进 ， 科 学 管理 ， 将 紧急 发 生 的 案例 科学 地 加 入 到 预防 性 维护 计划 中 去 ， 全 面 掌 控 设备 工 


况 ， 而 不 是 任 由 设备 停机 随机 发 生 。 


预防 性 维护 
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一 


图 9-1 设备 维护 理念 
二 、 维 护 方 法 分 类 


1. 紧急 维修 

紧急 维修 是 不 能 通过 事先 的 测试 或 监控 预测 到 的 ， 且 事先 并 无 明显 征兆 ， 也 无 发 展 过 程 
的 随机 故障 。 发 生 故 障 的 时 候 需 要 运用 最 为 合理 化 的 维修 措施 在 短 时 间 内 解决 ， 实 现 设 备 的 
正常 运转 。 

2. 修正 性 维修 

修正 性 维修 也 称 为 改善 性 维修 或 纠 错 性 维修 ， 是 通过 对 设备 零 部 件 进 行 
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件 更 换 、 尺 寸 补充 、 改 进 设计 和 制造 等 手段 ， 消 除 设备 的 先天 性 不 足 、 缺 陷 或 重复 性 故障 ， 
使 设备 的 性 能 得 到 恢复 和 改善 ， 从 而 提高 设备 将 来 的 可 徘 性 和 可 维护 性 。 

3. 预见 性 维护 

预见 性 维护 是 通过 收集 设备 日 第 维护 数据 ， 如 备件 更 换 、 保 机 故障 ， 将 收集 的 数据 分 
析 、 汇 总 ， 将 总 结 出 的 规律 或 经 验 纳入 预防 性 维护 计划 中 实施 。 

4. 预防 性 维护 

预防 性 维护 是 为 了 消除 设备 失效 和 生产 计划 外 中 断 的 原因 而 制定 的 措施 ， 作 为 制造 过 程 
设计 的 一 项 输出 ， 从 预防 的 角度 出 发 ， 根 据 设备 设计 指标 和 对 设备 的 异 状 进行 早期 发 现 和 早 
期 治疗 。 主 要 特点 是 ， 在 设备 或 去 部 件 尚未 失效 前 即 按照 保养 或 更 换 计划 进行 保养 或 替换 ， 
从 而 减少 非 计划 保 机 次 数 。 


三 、 机 器 人 工作 站 的 维护 方法 简介 


工业 机 器 人 工作 站 的 日 党 维护 工作 以 上 面 提 到 的 设备 维护 理念 为 指导 。 除 紧急 维修 外 ， 
一 般 包含 易 损 件 更 换 、 日 常 点 检 、 日 常 保养 和 定期 检修 四 个 主要 工作 内 容 。 四 种 工作 需要 相 
互 配合 才能 让 工作 站 的 工 况 健康 并 可 挖 发展， 形成 良性 循环 ， 下 面 对 四 种 维护 性 工作 加 以 简 
单 介 绍 。 

1. 日 常 点 检 

每 天 生产 开 班 之 前 和 班 中 工 位 空闲 时 间 ， 需 要 对 设备 的 关键 部 位 进行 目 视 或 接触 式 检 
查 ， 即 所 谓 的 点 检 。 目 视 检查 的 目的 在 于 及 时 地 发 现 设 备 异 常 ， 并 采取 措施 更 正 或 维修 设 
备 ， 这 样 既 能 保证 设备 在 开 班 后 正常 工作 ， 不 会 发 生 大 的 停机 事故 而 导致 生产 任务 耽搁 ， 又 
能 保证 用 此 设备 生产 出 来 的 零件 质量 是 能 够 得 到 保证 的 ， 不 会 因为 设备 的 不 健康 状态 导致 产 
品质 量 缺 陷 ， 造 成 产品 报废 。 例 如 对 于 滚 边 机 器 人 滚 边 轮 的 检查 ， 帮 能够 及 时 发 现 滚 边 轮 表 
面 的 坑 洼 ， 既 能 保证 滚 边 轮 在 滚 边 过 程 中 不 损坏 滚 边 模具 ， 造 成 滚 边 模具 哺 噬 ， 又 能 够 保证 
生产 出 来 的 产品 表面 没有 缺陷 。 因 此 这 种 方式 的 维护 工作 比较 简单 直接 ， 而 且 只 需 每 名 工人 
每 日 花费 数 分 钟 ， 维 护 成 本 非常 低 。 

日 常 点 检 通 常 以 现场 管理 看 板 的 形式 进行 组 织 ， 如 图 9-2 所 示 。 图 9-2 中 ， 年 度 点 检 计 划 
表 显 示 全 年 的 点 检 安 排 ， 每 个 月 执行 哪些 点 检 内 容 ; 点 检 操 作 指导 书 一 栏 存放 所 有 关于 此 工 位 
设备 点 检 工 作 的 标准 化 操作 指导 书 ， 其 中 包含 每 项 检查 需要 关注 的 点 源 、 使 用 什么 检查 方法 、 
是 否 使 用 工具 等 信息 。 检 查 班 次 安排 栏 分 为 不 同班 次 和 班组 ， 每 天 不 同班 次 和 班组 员工 按照 点 
检 卡 插 模 内 的 卡片 检查 不 同 内 容 ， 从 而 扩大 检查 和 覆盖面。 点 检 卡 根据 年 度 点 检 计 划 每 月 更 新 。 

2. 罗 损 件 更 换 

设备 在 运转 时 会 有 一 些 加 工 位 置 非常 容易 磨损 ， 例 如 修 磨 右 的 刀片 、 冲 孔 机 的 冲 头 等 。 
此 类 易 损 件 的 更 换 周 期 由 厂家 在 自己 的 实验 室 中 经 过 多 次 试验 得 出 ， 必 须 严 格 遵守 其 更 换 周 
期 ， 进 行 兄 损 件 的 更 换 ， 和 否则 会 造成 批量 质量 事故 及 不 必要 的 零件 返工 或 者 零件 报废 。 

3. 日 常 保养 

所 谓 日 党 保养 是 根据 广 家 提供 的 设备 保养 说 明 ， 对 设备 进行 探 拭 清理 ， 对 需要 润 请 的 部 
位 加 注 润 请 脂 等 操作 。 此 类 保养 时 间 需 根据 工作 站 的 产量 、 设 备 的 设计 保养 周期 和 设备 的 工 
况 共 同 评估 决定 。 一 般 日 常 保养 放 在 班 后 或 是 周末 停产 时 间 进 行 , 保养 之 后 需 做 好 记录 工 




































































作 ， 记 录 保 养 时 间 和 保养 类 型 ， 以 便 在 日 后 设备 出 现 紧急 停机 时 ， 分 析 原 因 并 及 时 调整 保养 
计划 时 间 间隔 或 方案 。 

XXX 工人 位 日 常 点 检 管 理 看 板 
年 度 点 检 计 划 点 检 操 作 指导 书 
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图 9-2 日 常 点 检 管 理 看 板 实例 





4. 定期 检修 

定期 检修 即 根据 厂家 对 其 设备 的 建议 维护 周期 ， 对 其 关键 部 位 进行 检查 。 此 类 检修 与 目 
视 检 查 的 区 别 是 目 视 检 查 要 求 时 间 短 ， 尽 量 不 用 特殊 工具 ， 而 定期 检修 一 般 需 要 在 停产 状态 
下 ， 检 查 设备 某 些 不 便于 观察 的 部 位 ， 或 是 需要 使 用 某 些 特定 的 工具 进行 检查 ， 以 对 运行 一 
段 时 间 的 设备 工 况 做 评估 。 班 前 目 视 检查 和 定期 检修 相互 配合 实施 能 够 让 设备 运行 在 良好 的 
工 况 下 ， 大 大 减少 设备 紧急 停机 的 次 数 。 

本 章 将 结合 上 述 四 种 维护 方法 ， 就 几 种 不 同类 型 的 机 器 人 工作 站 及 工业 机 器 人 本 身 的 维 
护 工 作 展 开 部 分 讨论 。 


第 二 生 对 焊 机 器 人 工作 站 的 日常 继 护 _、 


弧 焊 机 器 人 和 弧 焊 工艺 本 身 并 不 复杂 ， 如 图 9-3 所 
示 。 然 而 由 于 弧 焊 需要 消耗 焊丝 ， 需 要 送 丝 系统 和 机 器 人 
TCP 补偿 系统 配合 ; 焊丝 熔化 时 会 在 枪 嘴 处 堆积 大 量 的 氧 
化 物 ， 需 要 一 套 自动 更 换 枪 头 的 系统 ; 每 次 焊接 之 后 需要 
将 焊丝 熔断 ， 下 次 焊接 前 需要 重新 修理 焊丝 ， 这 个 过 程 需 
要 焊丝 修剪 系统 的 配合 ; 焊接 时 产生 弧 光 和 废气 ,需要 弧 | 
光 防 护 系 统 和 排 风 系 统 的 配合 ， 这 就 导致 了 全 自动 弧 焊 机 | 
器 人 工作 站 的 结构 比较 复杂 。 以 上 所 述 的 几 个 系统 都 需要 
做 日 常 的 维护 和 保养 ， 这 也 增加 了 日 常 维护 保养 的 工作 量 。 

下 面 根据 弧 焊 机 器 人 工作 站 各 个 组 件 的 功能 ， 将 弧 焊 
机 器 人 工作 站 予以 功能 性 拆 分 ， 并 分 别 介绍 各 个 部 分 的 日 
常 维护 保养 工作 。 各 个 部 件 精细 的 保养 计划 请 参考 厂家 手 
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图 9-3” 弧 焊 机 副 人 
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册 。 绝 焊 机 器 人 工作 站 的 组 成 如 图 94 所 示 。 











图 94 弧 焊 机 右 人 工作 站 的 组 成 


图 94 中 的 组 件 名 称 及 其 对 应 的 日 常 维护 工作 见 表 9-1。 


表 9-1 弧 焊 机 器 人 工作 站 的 日 常 维护 





































































































序号 名 称 日 常 维护 工作 维护 周期 维护 方式 
全 查 控 制 柜 是 否 有 异 响 ， 柜 子 是 否 有 异常 拌 动 ， 散 热 
1 “| 孤 烛 系统 控制 柜 ee 
符 系 统 控制 柜 | 是否 有 异常 ， 日 常 保持 柜 门 关闭 ， 防 止 灰尘 进入 TE | ee 
检查 机 器 人 本 体 是 否 有 漏 油 ， 运 动 时 是 否 有 异 响 ， 检 
2 机 器 人 个 预 六 性 维 > 
a 可 机 器 人 一 轴 处 的 插头 是 否 有 松动 a 
3 控制 柜 插头 仿 查 插头 是 否 有 松动 年 检 “| ”假期 预防 性 维护 
4 送 丝 接口 仿 查 送 丝 接口 机 械 固定 是 否 有 松动 月 检 “| “假期 预防 性 维护 
5 送 丝 盘 检查 送 丝 盘 转动 是 否 良好 ， 丝 是 否 整齐 盘 布 日 检 ”| 日 点 检 和 日 常 保养 
检查 盘 丝 桶 内 部 丝 是 否 有 缠绕 ,检查 焊 丝 是 否 够 一 个 
6 盘 丝 权 日 检 ”| 日 点 检 和 日 党 
| 班 生产 使 用 ， 否 则 及 时 准备 新 的 丝 卷 、 PA 
7 “| 机 器 人 与 焊 枪 连接 板 | 检查 连接 板 上 的 接头 是 否 有 松动 半年 检 | ”假期 预防 性 维护 
检查 烛 枪 是 否 固定 牢靠 ， 烛 枪 表面 是 否 有 污 物 ， 爆 枪 
焊 烛 季 检 点 检 和 日 党 
8 弧 焊 焊 枪 枪 嘴 是 否 有 堵塞 李 检 日 点 检 和 日 党 保养 
9 送 丝 管 检查 送 丝 管 护 套 是 否 有 破损 ， 是 否 有 异常 应 力 月 检 “| 日 点 检 和 日 常 保养 
10 吊装 支架 检查 吊装 支架 是 否 有 异常 晃动 空间 季 检 ”| ”假期 预防 性 维护 
检查 平衡 器 的 工 况 ， 是 否 有 卡 顿 ， 二 次 保护 是 否 连接 
11 平衡 中 月 检 ”| 假期 预防 性 维护 
oa 牢靠 钢丝绳 是 否 有 破损 
12 枪 头 清洁 站 清洁 枪 头 清洁 站 中 的 垃圾 日 检 “| 日 点 检 和 日 党 保养 
13 水 气 连接 板 检查 水 气 是 否 有 泄漏 ， 接 头 处 是 否 有 锈蚀 月 检 “| 日 点 检 和 日 常 保养 
仿 查 控制 器 面板 是 否 有 污 物 ， 线 缆 是 否 缠绕 整齐 ， 控 
二 | 姓 搂 要 侧 肪 可 作 曾 荫 | 日 检 。 | 日 点 检 和 日 常 保养 
制 器 是 否 有 破损 











第 九 章 工业 机 器 人 工作 站 的 维护 “人 















































( 续 ) 
序号 名 称 日 常 维护 工作 维护 周期 维护 方式 
清理 更 换 下 的 废料 ， 码 放 新 的 枪 踢 ， 检 查 各 个 传感器 

15 嘴 自 却 装置 日 检 日 点 检 和 日 常 
枪 嘴 自动 更 换 装置 | ， 从 太 旺 天 下 检 检 和 日 常 保养 
16 | TCP 校 验 工具 检查 此 工具 位 置 是 否 有 异常 挪动 ， 清 理 表面 污 物 月 检 | 日 点 检 和 日 常 保养 
17 | 焊 缝补 偿 传感器 仿 查 传感器 的 连接 ， 检 查 状态 指示 灯 是 否 有 异常 月 检 | 日 点 检 和 日 常 保养 
仿 查 接地 装置 及 其 地 线 连 接 是 否 牢靠 ， 将 其 表面 污 
18 接地 装置 We | 和 格 。| 入 其 闫 也 性 维护 

清理 干净 

19 排 风 设备 检查 排 风 装置 的 吸力 是 否 正常 月 检 | 日 点 检 和 日 常 保养 
20 弧 光 防护 帘 仿 查 弧 光 防护 帘 是 否 有 破损 ， 若 有 破损 及 时 打 补 丁 ”| 半年 检 | ”假期 预防 性 维护 


由 表 9-1 可 见 ， 通 常情 况 下 ， 设 备 的 很 多 月 检 、 季 检 内 容 按照 年 度 点 检 计 划分 配 到 日 点 
检 工 作 中 去 ， 按 周期 滚动 检查 ， 以 提高 维 保 效 率 ， 保 证 设备 工 况 可 控 。 对 于 一 些 长 周期 、 耗 
时 或 需要 专业 检修 技能 和 设备 的 检修 ， 安 排 到 预防 性 维护 工作 中 ， 在 生产 线 停 线 的 时 候 组 织 
人 力 、 物 力 进行 检查 ， 其 他 的 机 各 人 工作 站 检查 维护 工作 也 可 按照 此 思路 进行 。 


第 三 节点 焊 机 高 人 工作 站 的 日 党 维护 


点 焊 机 融 人 工作 站 比较 人 简单， 一般 由 机 带 人 、 点 焊 枪 和 水 气 单元 组 成 。 但 是 由 于 点 焊工 
艺 需 求 ， 此 项 技术 需要 有 冷却 循环 水 和 压缩 空气 作为 媒介 。 冷 却 循环 水 需要 单独 的 管道 接头 
引入 焊 枪 ， 需 要 有 水 阔 控 制 其 通 断 ， 还 需要 回 水 管道 。 压 缩 空 气 需要 气 路 逻辑 控制 元 件 ， 需 
要 管道 将 其 引入 焊 枪 。 基 于 以 上 两 个 媒介 ， 点 焊 机 甫 人 工作 站 内 接头 比较 多 ， 跑 冒 滴 漏 和 腐 
人 刨 现象 也 比较 常见 ， 需 要 经 常 进行 目 视 检查 和 听觉 检 查 。 

由 于 点 焊 时 能 量 非 常 大， 因此 焊 检 与 工件 必须 保证 垂下， 否则 驶 会 造成 焊接 飞溅 ， 温 度 
很 高 的 液体 金属 会 以 很 高 的 速度 飞溅 出 来 ， 而 且 飞溅 的 方向 一 般 不 固定。 这 类 飞溅 对 于 焊 枪 
本 号 的 水 管 软 管 、 气 管 和 线 绕 都 有 灼伤 ， 因 此 焊 枪 水 气管 路 均 使 用 阻 燃 材料 或 穿 防护 枪 衣 ， 
枪 衣 的 材料 一 般 为 防火 材料 。 

下 面 就 点 焊 机 絮 人 工作 站 的 不 同 组件 分 别 介绍 其 维护 保养 工作 。 


一 、 点 焊工 作 站 日 点 检索 


图 9-5 是 点 焊工 作 站 的 日 点 检 表 之 一 ， 操 作 人 员 每 天 按照 计划 对 表 中 的 内 容 进 行 检 查 ， 
发 现 问题 及 时 通知 相关 人 员 处 理 。 


二 、 焊 枪 的 维护 


机 天 人 点 焊 焊 枪 一 般 分 为 气动 点 焊 焊 枪 和 伺服 点 焊 焊 枪 。 气 动 点 焊 焊 枪 的 开 合 由 纯 气 路 
逻辑 控制 ， 无 法 实现 非常 精细 的 控制 ， 相 应 的 成 本 比较 低 。 现 在 主流 的 点 焊 机 人 各 人 使 用 伺服 
已 焊 焊 枪 ， 其 优点 是 可 以 通过 机 各 人 变频 副 控 制 输出 不 同 的 电流 ， 结 合 伺服 编码 副 对 焊接 压 
力 和 电极 臂 的 行程 实现 非常 精细 的 控制 ， 并 对 焊接 压力 实现 有 效 反 馈 ， 让 焊接 质量 进一步 可 
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备注 : | 周期 : 


图 9-5 点 焊 机 器 人 工作 站 的 日 点 检 表 
控 。 图 9-6 所 示 为 机 如 人 伺服 点 焊 焊 枪 。 

焊 枪 结构 大 致 可 分 为 电动 机 及 其 传动 箱 、 电 极 臂 、 平 衡 枉 、 变 压 带 、 分 流 和 项 和 水 气管 路 
几 个 部 分 ， 如 图 9-7 所 示 。 其 中 由 于 各 个 部 件 的 中 到 
特性 ， 电 动机 及 其 传动 箱 、 补 偿 气 适 、 电 极 臂 和 
分 流 帮 是 日 常 维护 的 重点 关注 部 位 ， 下 面 分 别 说 
明 。 

(1) 电动 机 及 其 传动 箱 ” 焊 枪 的 伺服 电动 机 
行程 较 短 ， 运 行 时 转 矩 较 大 ， 长 时 间 运 转 易 造成 
传动 机 构 磨 损 和 电动 机 输出 转 矩 不 准确 ,极端 情 
况 下 甚至 会 造成 电动 机 卡 死 ， 因 此 此 部 件 需要 重 
点 保养 。 

(2) 补偿 气 氏 ”此 部 件 有 压缩 空气 接 入 ， 由 图 9-6 何 服 点 焊 香 枪 
于 焊接 飞溅 等 原因 容易 导致 漏 气 ， 气 和 也 会 因 多 次 运行 而 容易 出 现 密封 件 老化 的 问题 。 

(3) 电极 辟 ” 电 极 臂 通常 由 皱 铜 制 成 ,质地 非 第 软 ， 且 电极 臂 内 部 设计 有 冷却 水 流动 
通道 ， 因 此 在 大 臂 和 小 臂 接 头 处 、 电 极 头 处 易 发 生 漏水 现象 。 

(4) 分 流 秀 ”每 焊接 一 次 分 流 融 就 需要 跟随 焊 枪 动 臂 做 一 次 这 折 ， 多 次 弯 折 易 导 致 分 
流 厂 整体 折断 。 

基于 以 上 原因 ， 将 焊 枪 关键 融 件 的 维护 在 表 9-2 列 出 。 


三 、 水 管 、 水 过 滤 、 水 气 单元 (RIP) 的 维护 


冷却 循环 水 是 点 焊 机 副 人 工作 站 的 为 一 个 故障 高 发 的 系统 。 冷 却 水 分 为 来 水 和 回 水 ， 温 
度 较 低 的 冷却 水 从 工 广 的 动力 中 心 输送 过 来 ， 流 经 水 过 滤 秀 ， 如 图 9-8 所 示 。 将 其 中 的 杀 























和 水 拆 过 滤 ， 再 流 经 机 项 人 水 气 单元 ， 如 图 9-9 所 示 。 通 过 水 气 单元 ， 机 带 人 可 以 控制 水 流 
的 通 断 ， 便 于 在 更 换 电极 时 关 断 水流 。 循 环 水 经 过 RIP 流 经 点 焊 枪 的 电极 头 ， 温 度 升 高 ， 再 
经 过 RIP 到 回 水 管 ， 输 送 回 动力 中 心 ， 这 便 是 冷却 水 的 完整 循环 。 


电动 机 





图 9-7 ”点 焊 焊 枪 结构 
表 9-2 点 焊 焊 枪 关 键 器 件 的 维护 





元 件 维 护 措 施 维护 周期 维护 方式 
电动 机 滚动 螺杆 和 涂 上 油脂 半年 检 | 假期 预防 性 维护 
补偿 气 生 I 检查 气 包 密封 处 是 否 泄漏 半年 检 | 假期 预防 性 维护 





全 查分 流 器 ， 若 有 损坏 ， 则 需 拆除 、 清 理 、 上 油脂 、 重 装 每 一 道 工序 ， 
检查 分 流 名 有 损坏 ， 则 需 拆 除 、 清 上 日 每 一 握 工 厅 孙权 ER 

















分 流 器 
2 锁 紧 所 有 螺钉 ， 检 查分 流 器 状态 ， 去 掉 损 坏 部 分 ,重新 安装 分 流 器 

电极 辟 检查 任何 漏水 现象 及 可 能 的 焊 钳 辟 破 列 月 检 | 日 点 检 和 和 日常 保养 
电缆 和 软 管 | 检查 电缆 和 软 管 的 状态 ， 检 查 机 器 人 线 线 包 是 否 有 破损 月 检 | 日 点 检 和 和 日常 保养 


注 : 由 于 点 焊 焊 枪 数量 庞大 ， 因 此 出 故障 的 概率 比较 高 ， 对 于 备 枪 的 管理 也 是 点 焊 机 器 人 工作 站 日 常 维护 工作 的 一 
个 重点 〈 例 如 备 枪 运输 小 车 、 备 枪 存储 区 的 划分 等 ) 。 对 某 些 焊 点 比较 多 的 焊 枪 ， 一 般 用 备 枪 定期 蔡 换 工作 的 焊 
枪 ， 离 线 维修 ， 然 后 再 将 其 作为 备 枪 。 





图 9-8 ”循环 水 过 滤 需 图 9-9 ”机 器 人 水 气 单 元 


mn 


循环 水 过 滤 紫 的 清洁 周期 根据 水 流 总 量 而 定 ， 水 流量 越 大 ， 则 需要 清洁 的 频率 也 就 越 高 
(具体 清洁 周期 须根 据 厂家 说 明 书 而 定 )。 清 洁 时 需要 打开 盖子 ， 用 毛 刷 清洁 内 部 的 滤芯 和 
过 滤器 的 内 胆 ， 并 将 产生 的 脏 水 处 理 掉 ， 防 止 污 水 污染 地 面 。 

RIP 需要 每 天 开 班 之 前 检查 水 气 单 元 的 水 流量 信息 ， 寿 水 流量 过 小 ， 则 需 做 一 定 的 调整 
工作 ， 让 冷却 水 流量 达到 要 求 流量 。 

男 外 日 常 须 检 查 水 管 是 否 有 泄漏 ， 接 头 处 是 否 有 锈蚀 ， 杜 绝 跑 冒 滴 源 ， 让 水 循环 系统 保 
持 恨 好 工 况 。 


四 、 修 磨 器 


点 焊 焊 接 多 个 点 后 ， 电 极 头 表面 会 有 氧化 物 堆积 ， 造 成 电极 头 导 电 性 能 不 佳 ， 影 响 焊 接 
效果 。 因 此 在 执行 一 定数 量 的 点 烛 之 后 ， 焊 枪 电 ， 几 | / 
极 头 需要 修订， 由 修 魔 器 刀片 将 电极 头 表 面 的 一 、 国 
层 前 掉 ， 露 出 不 沾 有 氧化 物 的 表面 。 以 上 的 过 程 
中 负责 切削 电极 头 的 设备 称 为 修 磨 器 ， 如 图 9-10 
所 示 。 修 磨 器 中 最 关键 的 部 件 为 修 磨 刀 片 ， 它 负 
责 电极 头 表面 的 切 前， 因此 也 容易 损坏 。 每 日 需 
对 修 磨 器 刀片 做 目 视 检查 ， 若 目 视 检查 发 现 有 破 
损 ， 须 及 时 更 换 刀 片 。 

注 : 若 想 测试 修 磨 效果 ， 可 在 焊 枪 的 上 下 电 ”必要 2 
极 上 涂 上 颜色 ， 强 制 修 磨 ， 看 颜色 是 否 被 完全 麻 和 
掉 ， 进 而 决定 是 否 更 换 刀 片 。 


第 四 刷 ” 深 边 机 得 人 工作 站 的 日 莹 维护 


滚 边 机 需 人 工作 站 的 主要 组 成 为 机 人 硕 人 滚 
边 轮 和 深 边 工 沪 ， 如 图 9-11 所 示 。 滚 边 轮 没 有 
太 多 电器 元 件 ， 其 机 械 结构 也 相对 简单 ， 因 此 
比较 容易 做 维护 工作 。 但 滚 边 技 术 往 往 伴 随 着 
涂 胶 ， 深 边 轮 或 是 深 边 工 次 上 经 常 慕 附 有 胶 ， 
长 时 间 未 清理 的 胶 风 干 之 后 导致 深 边 工装 表面 
不 平整 ， 将 会 对 深 边 质量 有 所 影响 ， 因 此 日 党 










































清 胶 工作 尤为 重要 。 
下 面 分 述 滚 边 机 器 人 工作 站 中 滚 边 轮 和 滚 ,得 
边 工 装 的 维护 。 图 9-11 滚 边 机 器 人 及 其 工装 


一 、 滚 边 轮 检 查 


滚 边 轮 结构 如 图 9-12 所 示 ， 多 个 滚 边 轮 安 装 在 滚轮 总 上 ， 滚 边 轮 乔 内 部 的 轴承 转动 。 


依据 对 滚 边 机 釉 人 工作 站 的 维护 经 验 ， 得 出 以 下 三 个 检查 准则 : 

1 ) 检查 深 边 轮 固定 螺栓 是 否 松 动 ， 深 边 轮 是 否 有 园 量 。 

2) 检查 深 边 轮 表 面 是 否 有 杂 物 ， 是否 有 坑 洼 ,大 有 则 尽快 更 换 深 边 轮 。 

3) 检查 深 边 轮 是 否 转 动 良好 ， 否 则 更 换 轴承 (此 轴承 一 般 为 免 维 护 轴承 ) 。 

由 于 以 上 检查 比较 简单 ， 易 于 执行 ， 对 于 滚 边 机 天 人 工作 站 能 否 生产 出 来 合格 的 工件 也 
具有 重要 意义 ， 因 此 每 天 开 班 之 前 须 执 行 上 述 检查 。 

















二 、 滚 边 工装 检查 
滚 边 工装 是 滚 边 机 器 人 工作 站 另 一 个 需要 维护 的 关键 部 位 ， 如 图 9-13 所 示 。 滚 边 工装 
一 般 使 用 工件 的 3D 数 模 加 工 成 形 并 淳 火 ， 表 面 极其 坚硬 耐 磨 ， 工 件 在 其 表面 随 着 机 器 人 滚 
边 轮 的 几 次 “ 碾 压 ”成 形 ， 若 其 表面 不 平整 ， 或 是 有 异物 ， 则 会 将 工件 表面 稳 出 坑 包 ， 长 
时 间 带 着 异物 加 工 工件 ， 会 对 滚 边 工装 造成 不 可 恢复 的 损伤 ， 并 且 会 大 大 缩短 滚 边 轮 的 使 用 


寿命 。 





图 9-12 滚 边 轮 结构 图 9-13” 深 边 工装 


滚 边 工 装 的 检查 可 以 目 视 完成 。 滚 边 工 装 表 面 要 求 为 金属 色 ， 无 污 物 ， 没 有 坑 洼 ， 奉 有 
异 般 ， 则 需 专业 人 员 修复 或 更 换 备 用 滚 边 工 装 ， 检 查 周 期 也 为 每 班 开 班 前 检查 。 


三 、 深 边 工作 站 日 点 检索 





深 边 工作 站 每 日 点 检 内 容 集中 在 涂 胶 设备 、 深 边 工装 、 深 边 轮 和 机 右 人 人 上。 图 9-14 是 
滚 边 工作 站 的 涂 胶 设备 日 点 检 表 样 例 ， 图 9-15 是 深 边 工作 站 上 件 工 位 关键 器 件 维 护 表 样 例 。 


四 、 工 业 机 器 人 常见 故障 及 处 理 





工业 机 各 人 已 经 经 过 几 代 的 发 展 ， 机 械 结构 的 设计 日 缀 完善 。 日 第 使 用 中 硅 没 有 碰撞 事 
故 ， 机 各 人 本 体 机 械 部 件 很 少 出 现 故 障 ， 机 械 结构 的 保养 也 非常 简单 。 以 KUKA 机 各 人 为 
例 ， 只 需要 每 5 年 更 换 一 次 润滑 油 即 可 。 然 而 随 着 工业 通信 息 线 技术 、 控 制 系统 的 车 新 ， 机 
船 人 的 电气 系统 更 新 换代 比较 快 ， 因 而 电气 系统 稳定 性 不 如 机 械 系统 。 
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, 设备 日 常 点 检 保 养 卡 
设备 名 | 。 涂 胶 系统 设备 编号 : 
序号 项 目 检查 内 容 周期 要 求 
1 | 涂 胶 压 各 变形 、 松 动 日 | SEE 辽 3952 
要 y es 
胶 泵 压力 ( 胶 温 、 区 Sn < 2 
和 2 是 否 符合 工艺 范围 | 日 
3 泵 头 是 否 溢 胶 日 - 
4 胶 泵 系统 是 否 有 异 响 日 
5 气 拭 是 否 完好 、 无 泄 沁 | 日 | 区 < 看 
6 “| “控制 系统 指示 灯 是 否 正常 “| 日 
7 “| 系统 气 源 压力 | ”是 否 符合 工艺 要 求 
8 “| 胶 枪 喷 踊 变形 、 松 动 7 = 
9 | 胶 奈 、 胶 枪 系统 清洁 , WS 剖 
VV Er 
I * 衣 六 这 22142013 二 
图 9-14 ” 涂 胶 设备 日 点 检 表 样 例 








SD21( 上 件 台 ) 设备 日 常 点 检 保 养 卡 
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图 9-15 





深 边 工作 站 上 件 工 位 关键 器 件 维护 表 样 例 


需要 注意 的 是 在 做 任何 故障 排查 和 故障 处 理 之 前 ， 一 定 要 确保 机 器 人 已 经 做 了 备份 。 下 
面 就 机 各 人 的 机 械 和 电气 方面 一 些 常 见 故障 予以 介绍 ， 部 分 故障 加 以 实例 分 析 。 

(一 ) 起 动 故 障 

机 何人 不 能 正常 起 动 是 比较 第 见 的 故障 ， 首 先 要 排除 外 部 供电 系统 的 异常 ， 然 后 开始 排 
查 机 各 人 控制 柜 。 起 动 故 障 可 能 会 有 的 各 种 症状 所 有 单元 上 的 LED 灯 均 未 腕 起 ; 接地 故 


障 保护 跳 闻 ; 无 法 加 载 系 统 软 件 ; 示 教 器 没有 响应 ; 示 教 器 能 够 起 动 ， 但 对 任何 输入 均 无 响 
应 ; 系统 软件 未 正确 起 动 等 。 

此 类 故障 须 确保 系统 的 主 电源 通电 并 且 在 指定 的 极限 之 内 ， 确 保 驱 动 模块 中 的 主 变压器 
正确 连接 现 有 电源 电压 ， 确 保 控制 模块 和 驱动 模块 的 电源 供应 没有 超出 指定 极限 。 必 要 时 需 
用 万 用 表 测量 控制 柜 内 的 线路 ， 尽 量 定位 故障 ， 然 后 更 换 相 应 的 故障 模块 。 由 于 能 够 导致 起 
动 故障 的 原因 非常 多 ， 因 此 在 短 时 间 内 不 能 排除 故障 时 ， 需 要 将 控制 柜 整 体 替 换 ， 然 后 将 备 
份 的 机 器 人 数据 导入 机 器 人 ， 以 尽快 恢复 生产 ， 然 后 将 有 故障 的 设备 离线 修理 。 

(二 ) 油渍 沾 污 电动 机 和 齿轮 箱 

1. 故障 描述 

此 类 故障 的 症状 为 电动 机 或 变速 箱 周围 的 区 域 出 现 油 泄漏 的 征兆 。 这 种 情况 可 能 发 生 在 
底座 、 最 接近 配合 面 ， 或 者 在 分 解 器 电动 的 最 远 端 。 该 症状 可 能 由 以 下 原因 引起 : 齿轮 箱 和 
电动 机 之 间 的 防 泄漏 密封 损坏 ;变速 箱 油 面 过 高 或 变速 箱 油 过 热 。 

对 此 的 解决 方案 一 般 为 检查 电动 机 和 齿轮 箱 之 间 的 所 有 密封 和 垫圈 ， 不 同 的 操纵 器 型 号 
使 用 不 同类 型 的 密封 。 根 据 每 个 机 器 人 的 产品 手册 中 的 说 明 更 换 密封 和 垫圈 ， 检 查 齿轮 箱 油 
面 高 度 ， 若 高 度 过 低 ， 则 需 按 照 油 品 型 号 添加 。 齿 轮 箱 过 热 可 能 由 以 下 原因 造成 : 使 用 的 油 
的 型 号 或 油 面 高 度 不 正确 ; 机 器 人 工作 周期 运行 特定 轴 出 现 困难 (可 以 尝试 在 应 用 程序 编 
程 中 写 入 小 段 的 “冷却 周期 ”， 即 在 某 些 连续 运动 的 语句 中 间 适 当 加 入 等 待 时 间 ， 避 免 出 现 
连续 高 速 运转 ) ; 齿轮 箱 内 有 可 能 出 现 过 大 的 压力 。 

2. 案例 分 析 

如 图 9-16 所 示 ， 某 台 机 器 人 从 电动 机 下 方 漏 油 ， 机 器 人 臂 上 出 现 油 渍 。 对 此 首先 判断 
油渍 的 颜色 ， 若 油渍 为 淡 绿 色 ， 则 为 齿轮 p> 
箱 油 ， 说 明 齿 轮 箱 内 有 故障 或 是 齿轮 箱 密 
封 出 现 问题 ， 一 般 保 守 起 见 更 换 机 器 人 臂 ; 
若 油渍 为 透明 或 淡 黄色 ， 则 为 电动 机 轴 在 三 
组 装 阶段 涂抹 的 油脂 ， 须 检查 电动 机 的 密 
封 。 现 场 检查 之 后 发 现 油渍 为 透明 色 ， 又 
由 于 机 器 人 还 在 质保 期 内 ， 因 此 将 电动 机 
整体 拆 下 ， 替 换 为 新 的 备件 电动 机 ， 对 机 
器 人 重新 做 零点 校正 ， 然 后 将 损坏 的 电动 
机 寄 回 机 器 人 公司 并 索赔 新 的 电动 机 。 

( 三) 机 械 噪声 

1. 故障 描述 

在 操作 期 间 ， 电 动机 、 变 速 箱 、 轴 承 图 916 漏 油 的 机 天 人 
等 不 应 发 出 机 械 噪声 。 出 现 故障 的 轴承 在 损坏 之 前 通常 发 出 短暂 的 摩 控 声 或 者 中 哄 声 。 损 坏 
的 轴承 造成 路 径 精 确 度 不 一 致 ， 在 严重 的 情况 下 ， 接 头 会 完全 抱 死 。 

该 症状 可 能 由 以 下 原因 引起 : 轴承 磨损 ， 污 染 物 进 入 轴承 圈 ， 轴 承 没 有 润滑 。 如 果 从 变 
速 箱 发 出 噪声 ， 也 可 能 是 机 器 人 过 热 。 

解决 方案 为 确定 发 出 噪声 的 部 位 ， 若 是 轴承 ， 则 应 确保 轴承 相应 的 润滑 ;若是 电动 机 ， 
则 需 待 电动 机 冷却 后 继续 观察 ， 故 障 若 未 消除 ， 则 需 更 换 电 动机 并 做 零点 校正 ;若是 变速 箱 
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则 需 更 换 机 逢 人 臂 。 

2. 案例 分 析 

在 正常 生产 过 程 中 ， 一 台 机 絮 人 发 出 刺耳 的 异 啊 ， 走 近 机 右 人 能 够 感觉 到 机 器 人 附近 的 
地 面 有 振动 。 首 先 怀疑 是 机 絮 人 轴 有 机 械 故 障 ， 将 机 絮 人 打 到 手动 ， 让 其 单 轴 运 动 ， 奉 某 个 
轴 有 机 械 卡 死 的 情况 ， 则 在 手动 单 轴 动 作 时 会 报 出 轴 转 矩 过 大 。 逐 个 轴 检 查 后 并 未 发 现 异 
常 ， 因 此 排除 轴 的 故障 ， 剩 下 的 机 械 部 件 只 有 平衡 枉 ， 如 图 9-17 所 示 。 打 开平 衡 包 观察 孔 ， 
发 现 内 部 润 请 不 够 ， 用 凡士林 对 其 润滑 后 故障 消失 。 
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图 9-17 机 器 人 及 其 平衡 生 


(四 ) 示 教 器 与 控制 器 之 间 的 连接 问题 

示 教 器 是 现场 进行 机 器 人 操作 编程 的 快捷 人 机 交互 工具 ， 如 图 9-18 所 示 。 

1. 故障 描述 | 

故障 的 症状 为 示 教 器 没有 反应 也 不 点 亮 ， 或 是 示 教 器 启 
动 ， 但 没有 显示 屏幕 图 像 。 可 能 的 原因 是 示 教 器 与 控制 柜 之 % 
间 的 连接 插头 松动 ， 或 是 控制 柜 内 插头 到 主 控 板 处 的 电线 有 
问题 。 

2. 案例 分 析 

解决 方案 为 检查 电源 到 主 计算 机 的 全 部 电 绕 ， 确 保 它们 
正确 连接 。 确 保 示 教 器 与 控制 器 正确 连接 。 检 查 控 制 器 中 所 | 要 
有 单元 的 各 个 LED 指示 灯 。 检 查 主 计算 机 上 的 全 部 状态 信 图 9-18 KUKA C2 机 器 人 示 教 器 
号 。 在 正常 生产 过 程 中 某 台 机 器 人 的 示 教 器 首先 发 生 闪 上 断 ， 
之 后 屏幕 不 点 亮 。 在 这 期 间 没 有 人 对 机 器 人 控制 柜 及 示 教 器 做 过 任何 操作 。 首 先 怀 疑 示 教 器 
和 控制 柜 本 体 的 插头 接触 不 好 ， 将 其 拔 下 重新 插 上 ， 在 拔 下 的 过 程 中 示 教 器 又 发 生 闪 断 ， 因 
此 确认 了 故障 为 示 教 器 插头 接触 问题 。 查 看 拔 下 的 示 教 器 插头 及 控制 柜 本 体 插座 ， 对 插 针 做 
了 微调 ， 问 题 得 以 解决 。 

(五 ) 不 一 致 的 路 径 精 确 性 和 零点 丢失 

机 器 人 TCP 的 路 径 不 一 致 。 路 径 经 常 变 化 ， 并 且 有 时 会 伴 有 和 轴承、 变速 箱 或 其 他 位 置 
发 出 的 噪声 。 该 症状 可 能 由 以 下 原因 引起 : 机 器 人 没有 正确 校准 ; 未 正确 定义 机 器 人 TCP; 
在 电动 机 和 齿轮 之 间 的 机 械 接头 损坏 ( 它 通 常会 使 出 现 故 障 的 电动 机 发 出 噪声 ) ; 将 错误 类 

















型 的 机 卓 人 连接 到 控制 带 ; 制 动 曾 未 正确 松 开 。 

解决 方案 为 : 确保 正确 定义 机 需 人 工具 和 工作 对 象 ; 如 有 必要 ， 重 新 校准 机 右 人 轴 ; 通 
过 跟踪 噪声 找到 有 故障 的 电动 机 ; 分 析 机 器 人 TCP 的 路 径 ， 以 确定 哪个 轴 出 现 故障 ， 进 而 
确定 哪个 电动 机 可 能 有 故障 ; 确保 根据 配置 文件 指定 的 类 型 连接 正确 的 机 带 人 类 型 ， 确保 机 
船 人 制 动 闸 可 以 使 人 正确 地 工作 。 

除 以 上 描述 的 故障 外 ， 基 实 还 有 很 多 比较 常见 的 故障 ， 限 于 篇 幅 不 一 一 费 述 。 故 障 追 淹 
的 最 好 方法 是 查看 故障 日 志 ， 对 于 当前 正在 发 生 的 故障 或 是 已 经 发 生 过 多 次 的 故障 在 故障 日 
志 中 都 有 所 记录 ， 日 后 对 于 故 隐 的 总 结 和 分 析 都 需要 翻阅 故障 日 志 ， 应 该 对 故 隐 日 志 有 足够 
的 重视 。 























上 一 章 已 经 介绍 过 机 需 人 工作 站 的 组 成 ， 机 项 人 工作 站 可 以 被 看 作 是 有 一 定 智能 的 、 运 
用 一 定 工具 进行 特定 工序 的 “加 工人 ”。 它 通 第 以 PLC 〈 可 编程 序 控制 带 ) 为 大 脑 中 枢 ， 以 
Profibus 或 Profinet 等 工业 网 络 为 传输 神经 ， 以 机 如 人 、 变 频带 控制 的 电动 机 、 液 压气 动 元 件 
为 四 胶 ; 同时 ， 通 过 UOP (或 称 为 HMI) 人 机 操作 界面 作为 媒介 ， 可 以 和 真正 的 人 进行 沟 
通 ， 如 图 9-19 所 示 。 


























PC :用 于 编程 和 诊断 


UOP: 人 机 界面 盯 


(上 位 机 ) 或 模拟 上 位 机 
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图 9-19 机 恬 人 工作 站 控制 系统 原理 图 





那 怎 样 才能 高 效 地 和 它 进行 沟通 ,快速 知 道 它 的 问题 出 在 哪 呢 ?下面 将 阐述 判断 和 解决 
机 各 人 工作 站 故障 的 一 般 流程 和 思路 ， 然 后 对 常见 故障 及 其 解决 方案 进行 介绍 。 


一 、 机 器 人 工作 站 故障 诊断 流程 和 思 
不 同 机 副 人 工作 站 之 间 发 生 的 故障 差异 非常 大 ,但 是 机 帮 人 工作 站 故障 处 理 有 着 大 致 一 


\ 工业 机 器 人 技术 应 用 











样 的 流程 。 首 先 要 在 人 机 界面 上 进行 报警 信息 的 查看 ， 然 后 按照 系统 提示 定位 故障 点 源 ， 并 
使 用 相应 办 法 排除 故 隐 ;如 有 末 报 警 信 息 不 足以 找到 故 隐 点 ， 就 需要 结合 工 位 的 加 工 流 程 来 判 
断 目 前 的 停止 步 序 和 可 能 的 故障 原因 ， 其 至 需要 借助 PLC 编程 和 诊断 软件 进行 在 线 诊断 和 
实施 一 些 程序 应 急 修 改 方案 。 具 体 流程 可 参考 图 9-20。 


机 器 人 工作 站 发 
生 故 障 停止 
查看 UOP 上 位 
机 报警 信息 




















进行 PLC 在 线 诊 
报警 界面 明确 结合 工艺 流程 
指出 故障 点 判 段 政 隧 位 置 断 , 检 查 CPU 诊断 信 


息 .硬件 组 态 信 息 





























机 器 人 工作 站 故 
障 排除 


图 9-20 ”机 器 人 工作 站 故障 诊断 流程 


二 、 接 近 开 关 、 和 气缸 等 传 感 怖 不 到 位 或 误 点 亮 
传 感 带 是 工业 控制 系统 的 “眼睛 ”， 每 个 机 各 人 工作 站 内 部 有 大 量 的 传 感 带 。 夯 工件 变 








第 九 章 工业 机 器 人 工作 站 的 维护 “人 





形 或 是 传 感 副 本 刁 损坏 ， 传 感 融 会 发 出 错误 的 信和 号， 导致 机 人 各 人 工作 站 停机 。 

此 类 故障 很 常见 ， 解 决 方案 一 般 为 在 上 位 机 或 是 机 器 人 的 控制 面板 上 找到 状态 错误 传 感 
船 或 是 气缸 ， 记 住 传 感 带 的 现场 安 闭 位置， 到 安装 位 置 观 察 。 右 是 工件 问题 ， 则 将 工件 报废 
或 做 其 他 相应 处 理 ; 奉 是 传 感 磊 问题 ， 首 先 确保 传 感 磊 无 电磁 干扰 ， 然 后 用 金属 测试 ， 根 据 
测试 结果 更 换 传 感 融 或 做 其 他 处 理 。 


三 、 光 栅 和 光 雷 达 无 人 冯 入 即 报警 


由 于 现场 的 环境 ， 在 机 大 人 运动 过 程 中 ， 光 机 或 光 雷 达 等 安全 装置 有 可 能 被 飞 虫 、 焊 接 
飞溅 、 弧 光 、 杨 依 等 物体 激发 ， 或 有 时 光 雷 达 或 光栅 本 里 发 生 故 障 ， 造 成 系统 集 止 或 急 停 。 

排除 方法 : 充分 利用 光栅 和 光 雷 达 的 功能 ， 设 置 屏蔽 点 ， 降 低 光 雷达 扫描 速度 ， 可 有 效 
减少 此 类 故障 ， 光 雷达 需要 按 要 求 定期 清洁 。 


四 、 通 信和 总 线 中 断 


现在 的 机 名 人 工作 站 总 线 通信 一 般 为 Profibus 或 Profinet。 总 线 将 各 个 站 点 串联 在 一 起 构 
成 网 络 ， 然 后 各 个 节点 可 以 互相 访问 ， 因 此 站 内 的 网 络 通信 接头 非常 多 ， 在 有 一 个 接头 发 生 
松动 ， 就 会 导致 网 络 发 生 故 阶 ， 全 站 停止 工作 。 

此 类 故障 对 应 网 络 拓扑 图 ， 找 出 断 网 后 的 第 一 个 站 以 及 断 网 前 的 一 个 站 ， 检 查 两 端的 接 
头 和 其 中 的 网 络 线 绕 ， 必 要 时 用 提前 预制 的 线 统 予 以 将 换 ， 检查 故 障 是 否 消除 ， 右 能 够 消 
除 ， 则 将 故障 线 绕 予 以 更 换 ， 之 后 重新 激活 网 络 。 


五 、 机 器 人 丢失 任务 号 


柔性 生产 线 上 的 机 釉 人 工作 站 内 的 机 替 人 一 般 能 够 加 工 多 种 零件 ，PLC 会 根据 生产 线 内 
的 零件 信息 发 给 机 天 人 任务 号 ， 机 希 人 会 根据 不 同 任务 号 加 工 进入 机 锅 人 站 内 的 不 同 零件 。 
在 在 PLC 发 送 任务 号 时 机 天 人 处 于 断 网 状态 ， 在 工作 循环 中 机 硕 人 死机 或 是 一 些 其 他 异 和 
状况 发 生 ， 机 大 人 会 丢失 任务 号 ， 丢 失 任 务 号 之 后 机 天 人 站 会 俘 机 。 符 是 丢失 了 机 船 人 互 锁 
言 号 ， 机 筑 人 相互 之 间 更 有 发 生 碰 撞 的 危险 ， 切 不 可 贸然 直接 跳 过 信号 检测 语句 ， 强 行 恢复 
机 器 人 站 工作 。 

此 类 故 隐 最 安全 的 解决 方法 为 将 工件 导出 ， 所 有 机 融 人 回 到 Home 位 置 ， 全 站 初始 化 。 
但 是 这 样 会 使 未 加 工 成 形 的 零件 报废 。 硅 是 零件 成 本 比较 高 ， 必 须 恢复 机 大 人 工作 ， 在 保证 
机 各 人 互 锁 信号 正确 的 前 提 下 ， 可 以 给 机 各 人 模拟 任务 号 ， 硅 不能， 则 须 逐 台 手 动 操作 机 融 
人 完成 工作 ， 最 后 完成 全 站 初始 化 。 


六 、 机 融 人 础 撞 


随意 路 过 机 需 人 信号 检测 语句 ， 手 动 强行 干预 机 大 人 ， 或 是 在 调试 阶段 筷 记 机 各 人 互 锁 
信号 编写 ， 都 会 造成 机 需 人 碰撞 事故 的 发 生 。 此 类 故障 为 最 严重 的 机 需 人 站 事故 ， 奋 碰撞 轻 
微 ， 则 造成 暂时 停产 ， 以 检查 机 事 人 零点 是 否 丢 失 ; 奉 磁 撞 闫 重 ， 则 须 更 换 机 豆 人 。 因 此 此 
类 事故 的 重点 为 提前 做 好 预防 性 工作 。 
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一 方面 在 编程 的 时 候 需 要 对 所 有 运动 语句 加 上 碰撞 检测 ， 另 一 方面 需要 编写 一 些 辅助 程 
序 ， 让 机 器 人 在 正常 工作 状态 下 记录 某 些 点 的 位 置 ， 并 拍照 留存 。 发 生 碰撞 之 后 ， 让 机 器 人 
运行 之 前 的 程序 ， 对 照 照片 即 可 知道 机 器 人 运动 轨迹 是 否 偏 离 ， 如 图 9-21 所 示 。 

在 判断 机 器 人 没有 明显 机 械 故 障 的 前 提 。、、 
下 运行 程序 ， 若 机 器 人 轨迹 未 发 生 偏 移 ， 则 
可 恢复 生产 ; 若 机 器 人 轨迹 发 生 偏 移 ， 则 需 
对 机 器 人 做 零点 校正 ， 进 一 步 检 查 工 具 是 否 | 有 
受 损 : 若 受 损 ， 则 针对 受 损 部 位 进行 修复 ， > 《二 
然后 再 次 验证 此 点 ， 恢 复生 产 。 < 

总 之 ， 学 会 处 理 机 器 人 工作 站 日 常 故障 Ra” ee 
固然 重要 ， 但 更 重要 的 是 做 好 机 器 人 工作 站 乙 、 |is 
的 日 常 点 检 以 及 预防 性 维护 保养 工作 ,确保 、 计 2 人 
每 次 点 检 到 位 ， 每 次 保养 间隔 合适 ,不 仅 让 RB 中 下 于 
机 器 人 工作 站 尽量 少 发 生 故障 ， 更 要 保证 机 四 生生 和 本 
器 人 工作 在 良好 的 工 况 下 ， 延 长 设备 使 用 寿 图 9-21 机 器 人 碰撞 辅助 程序 检测 
命 ， 实 现 对 设备 的 科学 管理 。 



























工具 校 验 














由 于 工业 机 天 人 系统 复杂 而 且 和 危险 性 大 ， 在 手动 操作 机 天 人 或 机 天 人 系统 上 自动 运行 期 
间 ， 对 机 硕 人 及 其 周边 设备 进行 任何 操作 都 必须 注意 安全 。 无 论 什 么 时 候 进 入 机 需 人 工作 范 





围 都 可 能 导致 严重 的 伤害 ， 因 此 ， 工 业 机 大 人 的 安全 防护 尤为 重要 。 


”第 一 季 ”安全 防护 措施 


一 、 机 器 人 系统 的 布局 


机 右 人 系统 的 合理 布局 是 系统 安全 防护 的 第 一 步 。 机 天 人 控制 柜 宜 安 痛 在 安全 防护 空间 
外 。 这 可 使 操作 人 员 在 安全 防护 空间 外 进行 操作 、 局 动机 内 人 运动 完成 工作 任务 ， 并 且 在 此 
位 置 上 操作 人 员 应 具有 开阔 的 视野 ， 能 观察 到 机 符 人 运行 情况 及 是 否 有 其 他 人 员 处 于 安全 防 
护 空间 内 。 

机 名 人 系统 的 布置 应 避免 机 器 人 运动 部 件 和 与 机 器 人 作业 无 关 的 周围 固定 物体 及 设备 
(如 建筑 结构 件 、 公 用 设施 等 ) 之 间 的 挤 压 和 碰撞 ， 应 保持 有 足够 的 安全 间距 ， 一 般 最 少 为 
0. 5m。 但 那些 与 机 帮 人 完成 作业 任务 相关 的 设备 和 装置 (如 物料 传送 装置 、 工 作 台 、 相 关 
工具 台 、 相 关机 床 等 ) 不 受 约束 。 

当 要 求 由 机 各 人 系统 布局 来 限定 机 各 人 各 轴 的 运动 范围 时 ， 应 设 定 限定 装置 ， 并 在 使 用 
时 进行 带 件 位 置 的 正确 调整 和 可 徘 固定 。 

在 设计 末端 执行 侨 时 ， 应 使 其 当 动 力 源 (电气 、 液 压 、 气 动 、 真 空 等 ) 发 生变 化 或 动 
力 消失 时 ， 负 载 不 会 松 脱 落下 或 发 生 危 险 (如 飞 出 ); 同时 ， 在 机 右 人 运动 时 ， 由 人 负载 和 末 
端 执 行囊 所 生成 的 静 力 和 动力 及 力矩 应 不 超出 机 天 人 的 负载 能 

机 右 人 系统 的 布置 应 考虑 操作 人 员 进 行 手动 作业 时 ( 如 和 零件 的 上 、 下 料 ) 的 安全 防护 。 
可 通过 传送 装置 、 移 动工 作 台 、 旋 转 式 工作 人 台 、 滑 道 推 杆 、 气 动 和 液压 传送 机 构 等 过 渡 装 置 
来 实现 ， 使 手动 上 下 料 的 操作 人 员 置 号 于 安全 防护 空间 之 外 。 但 这 些 自 动 移出 或 送 进 的 装置 
不 应 产生 新 的 危险 。 


二 、 安 全 标示 


操作 机 需 人 或 机 般 人 系统 时 ， 应 严格 遵守 机 希 人 使 用 的 安全 规程 ， 因 此 了 解 机 需 人 系统 
遂 用 的 安全 标示 是 必需 的 。 机 需 人 系统 稼 用 的 安全 标示 ， 见 表 10-1。 
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表 10-1 安全 标示 


标示 名 称 含义 





警告 ， 如 果 不 依照 说 明 操 作 ， 就 会 发 生 事故 ， 并 导致 严重 或 致命 的 人 员 伤 害 














或 严重 的 产品 损坏 

on 警告 如 果 不 依照 说 明 操作 ， 可 能 会 发 生 事故 ， 造 成 严重 的 伤害 〈 可 能 致命) 
或 重大 的 产品 损坏 

电击 针对 可 能 会 导致 严重 的 人 身 伤害 或 死亡 的 电气 危险 的 警告 

pe 警告 如 果 不 依照 说 明 操作 ， 可 能 会 发 生 造 成 伤害 或 产品 损坏 的 事故 





静电 放电 (ESD) | ”针对 可 能 会 导致 严重 产品 损坏 的 电气 危险 的 警告 








注意 描述 重要 的 事实 和 条 件 
提示 描述 从 何 处 查找 附加 信息 或 如 何以 更 简单 的 方式 进行 操作 
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三 、 示 教 编程 器 的 安全 防护 


示 教 编程 希 是 一 种 高 品质 的 手持 式 终端 ， 它 配备 了 高 灵敏 度 的 一 流 电 子 设 备 。 为 避免 操 
作 不 当 引 起 的 故障 或 损害 ， 应 该 严格 避 照 以 下 说 明 进 行使 用 : 

1) 小 心 操作 ,不 要 摔 打 、 抛 掷 或 重 击 示 教 编程 毅 ， 这 样 会 导致 破损 或 改 隐 。 在 不 使 用 
该 设备 时 ， 应 将 它 挂 到 专门 存放 它 的 文 桨 上 ， 以 防 意 外 掉 在 地 上 。 

2) 示 教 编程 句 的 使 用 和 存放 应 避免 被 人 踩踏 电缆 。 

3) 切 勿 使 用 锋利 的 物体 操作 触摸 屏 ， 这 样 可 能 会 使 触摸 屏 受 损 。 应 用 手指 或 触摸 笔 去 
操作 示 教 编程 大 触摸 屏 。 

4) 定期 清洁 触摸 屏 。 灰 尘 和 小 颗粒 可 能 会 挡住 屏 大 造成 故障 。 

5) 切 勿 使 用 溶剂 、 洗 次 剂 或 探 洗 海 绢 清洁 示 教 编程 桌 ， 使 用 软 布 栈 少量 水 或 中 性 清洁 
剂 清洗 。 
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四 、 设 备 的 安全 防护 


(一 ) 确认 开关 状态 

高 压 作业 可 能 会 产生 致命 性 后 果 。 触 碰 高 压 可 能 会 导致 心跳 停顿 、 伐 伤 或 其 他 严重 伤 
害 。 为 了 避免 这 些 伤害 ， 请 务必 在 作业 前 关闭 控制 柜上 的 主 开 关 ， 如 图 10-1 所 示 。 

确保 驱动 模块 、 主 模块 的 主 开关 关闭 ， 如 图 10-2 所 示 。 
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图 10-1 关闭 控制 柜 的 主 开 关 图 10-2 关闭 驱动 模块 、 主 模块 的 主 开 关 


(二 ) 机 器 人 动作 的 危险 
使 用 示 教 编程 句 使 机 右 人 动作 时 ， 它 可 能 会 执行 一 些 意外 的 或 不 规范 的 移动 。 此 外 ， 所 
有 的 移动 都 会 产生 很 大 的 力量 ， 有 可 能 对 个 人 造成 严重 伤害 或 对 工作 范围 内 的 任何 设备 造成 
损害 。 因 此 ， 应 该 严格 按照 表 10-2 进行 操作 。 
表 10-2 ”使 用 示 教 编程 器 使 机 器 人 动作 
序号 操 作 








注 释 





示 教 编程 器 运行 之 前 ， 请 务必 正确 安装 和 连接 紧急 停止 


人 这 紧急 停止 设备 包括 防护 门 、 踏 垫 和 光 幕 等 
设备 








在 手动 全 速 模式 下 通常 只 有 止 - 动 功能 有 效 。 要 增加 安全 | 按 下 示 教 编程 器 的 使 能 键 ， 机 器 人 动作 ; 松 开 使 能 
性 ， 也 可 使 用 系统 参数 对 手动 限 速 激活 止 - 动 功能 键 ， 机 器 人 停止 动作 





























3 按 下 启动 按钮 之 前 ， 确 保 示 教 编程 器 的 工作 范围 内 无 人 | ”机 器 人 动作 之 前 ， 机 器 人 的 工作 区 域内 无 障碍 


(三 ) 轴 制 动 闻 的 作用 
机 船 人 手臂 系统 非 稼 沉重 ， 特 别 是 大 型 机 融 人 ， 如 果 没 有 连接 制 动 闸 、 连 接 错误 、 制 动 
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疗 损坏 或 任何 故障 导致 制 动 闸 无 法 使 用 ， 都 会 产生 危险 。 

例如 ， 当 KUKA200 机 各 人 手 辟 系统 跌落 时 ， 可 能 会 对 站 在 下 面 的 人 员 造 成 伤亡 。 因 
此 ， 应 采取 对 应 的 防范 措施 ， 具 体操 作 如 下 : 

1) 如 果 怀 疑 制 动 闸 不 能 正常 使 用 ， 请 在 作业 前 使 用 其 他 方法 确保 机 融 人 手臂 系统 的 安 








全 性 。 
2) 如 果 打 算 通 过 连接 外 部 电源 禁用 制 劲 闸 ， 请 务必 注意 : 当 禁 用 制 动 曾 时 ， 切 勿 站 在 
机 敌人 的 工作 范围 内 〈 除 非 使 用 了 其 他 方法 文 撑 手 臂 系 统 ); 任何 时 候 均 不 得 站 在 任何 机 可 
人 轴 臂 下方 。 

(四 ) 紧急 停止 

紧急 停止 是 一 种 超越 其 他 任何 示 教 编程 副 控 制 的 状态 ， 断 开 驱 动 电源 与 示 教 编程 带电 动 
机 的 连接 ， 停 止 所 有 运动 部 件 ， 并 上 断 开 电源 与 示 教 编程 名 系统 控制 的 任何 可 能 存在 危险 的 功 
能 的 连接 。 紧 急 停止 状态 意味 着 所 有 电源 都 要 与 示 教 编程 紫 断 开 连 接 ， 手 动 制 动 释放 电路 除 
外 。 只 有 执行 恢复 步 又 ， 即 重 置 紧急 停止 按钮 并 按 电动 机 开启 按钮 ， 才 能 返回 正常 操作 。 

在 机 各 人 运行 过 程 中 ， 工 作 区 域 有 人 员 阁 入 ,或 者 机 带 人 伤害 了 工作 人 员 或 损伤 了 机 带 
设备 时 ， 必 须 按 下 任意 紧急 停止 按钮 。 因 此 ， 紧 急 停止 功能 用 于 在 过 到 紧急 状况 时 立即 集 止 
设备 ， 不 得 用 于 正常 的 程序 停止 ， 因 为 这 可 能 会 给 示 教 编程 硕 珊 来 额外 的 不 必要 麻 损 。 

(五 ) 安全 停止 

安全 停止 意味 着 仪 断 开 示 教 编程 锅 与 电动 机 之 间 的 电源 ， 因 此 不 需要 执行 恢复 步 又 。 只 
需要 新 连接 电动 机 电源 ， 就 可 以 从 安全 停止 状态 返回 正常 操作 。 安 全 停止 也 称 为 保护 俘 止 。 

安全 停止 不 得 用 于 正 稼 的 程序 停止 ， 因 为 这 可 能 会 给 示 教 编程 右 带 来 额外 的 不 必要 魔 


























安全 停止 通过 输入 到 控制 右 的 特殊 信号 激活 ， 这 些 输入 专用 安全 装置 有 单元 门 、 光 幕 或 
光束 等 。 安 全 停止 类 型 见 表 10-3 。 
表 10-3 安全 停止 类 型 














安全 停止 描 ” 述 
自动 模式 停止 〈AS) 在 自动 模式 中 断 开 驱 动 电源 
常规 停止 (G5) 在 所 有 操作 模式 中 断 开 驱动 电源 
在 所 有 操作 模式 中 断 开 驱动 电源 
级 停 SS 
J 用 于 外 部 设备 





五 、 机 器 人 系统 的 安全 防护 装置 


机 从 人 系统 的 安全 防护 可 采用 一 种 或 多 种 安全 防护 痛 置 ， 如 : 

1) 固定 式 或 连锁 式 防 护 痕 置 。 

2) 双手 控制 装置 、 使 能 装置 、 握 持 - 运 行 装置 、 自 动 停机 装置 、 限 位 装置 等 。 

3) 现场 传 感 安 全 防护 装置 (PSSD) ， 如 安全 光 疾 或 光 屏 、 安 全 垫 系统 、 区 域 扫描 安全 
系统 、 单 路 或 多 路 光束 等 。 
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六 、 安 全 保护 


实际 操作 中 ， 有 些 危 险 不 能 合理 地 消除 或 不 能 通过 设计 完全 排除 。 安 全 保护 就 是 借助 保 
护 装置 使 作业 人 员 远 离 这 些 危 险 。 

某 些 安全 保护 装置 (如 光 幕 ) 激活 时 ， 保护 装置 可 以 通过 受 控 方式 停止 示 教 编程 器 来 
防止 危险 情形 。 这 可 通过 将 保护 装置 连接 到 示 教 编程 需 上 的 任何 安全 停止 输入 来 实现 。 

安全 保护 空间 是 由 机 器 人 外 围 的 安全 防护 装置 (如 栅栏 等 ) 所 组 成 的 空间 。 确 定安 全 
保护 空间 的 大 小 是 通过 风险 评价 来 确定 超出 机 器 人 限定 空间 而 需要 增加 的 空间 。 一 般 应 考虑 
当 机 器 人 在 作业 过 程 中 ， 所 有 人 员 身 体 的 各 部 分 应 不 能 接触 到 机 器 人 运动 部 件 和 末端 执行 器 
或 工件 的 运动 范围 。 例 如 ， 示 教 编程 器 单元 由 单元 门 及 其 互 锁 装置 进行 安全 保护 。 

每 个 现 有 保护 装置 都 具有 互 锁 装置 ， 激 活 这 些 装置 时 将 停止 示 教 编程 器 。 示 教 编程 器 与 
单元 门 含 有 互 锁 ， 在 打开 单元 门 时 该 互 锁 将 停止 示 教 编程 器 。 恢 复 正 常 操作 的 唯一 方法 是 关 
闭 单元 门 。 

安全 保护 机 制 包含 许 多 串联 的 保护 装置 。 当 一 个 保护 装置 启动 时 ， 保 护 链 断 开 ， 此 时 不 
论 保护 链 其 他 部 分 的 保护 装置 状态 如 何 ， 机 器 都 会 停止 运行 。 

















七 、 安 全 工作 区 域 


在 调试 与 运行 机 需 人 时 ， 它 可 能 会 执行 一 些 意 外 的 或 不 规范 的 运动 。 并 且 ， 所 有 的 运动 
都 会 产生 很 大 的 力量 ， 从 而 严重 伤害 人 员 或 损坏 机 融 人 工作 范围 内 的 任何 设备 。 所 以 工作 人 
员 必 须 时 刻 和 警惕 与 机 硕 人 保持 足够 的 安全 距离 ， 在 机 堪 人 的 工作 区 域 之 外 进行 操作 。 


八 、 工 作 中 的 安全 


机 硕 人 速度 慢 ， 但 是 很 重 并 且 力 度 很 大 ， 运 动 中 的 停顿 或 停止 都 会 产生 危险。 即使 可 以 
预测 运动 轨迹 ， 但 外 部 信号 有 可 能 改变 操作 ， 有 可 能 在 没有 任何 警告 的 情况 下 ， 产 生 预 想 不 
到 的 运动 。 因 此 ， 当 进入 保护 空间 时 ， 务 必 遵 循 所 有 安全 条 例 。 

1) 如 果 在 保护 区 域内 有 工作 人 员 ， 请 手动 操作 机 需 人 系统 。 

2) 当 进 入 保护 空间 时 ， 请 准备 好 示 教 编程 锅 ， 以 便 随 时 控制 机 逢 人 。 

3) 注意 旋转 或 运动 的 工具 ， 例 如 切削 工具 和 饮 。 确 保 在 接近 机 天 人 之 前 ， 这 些 工具 已 
经 停止 运动 。 

4) 注意 工件 和 机 符 人 系统 的 高 温 表 面 。 机 釉 人 电动 及 长 期 运转 后 温度 很 高 。 

5) 注意 夹具 并 确保 夹 好 工件 。 如 有 果 夹 具 打 开 ， 工 件 会 脱落 并 导致 人 员 伤害 或 设备 损 
坏 。 夹 具 非 常 有 力 ， 如 果 不 按照 正确 方法 操作 ， 也 会 导致 人 员 伤害 。 

6) 注意 液压 、 气 压 系统 以 及 带电 部 件 。 即 使 断 电 ， 这 些 电路 上 的 残余 电量 也 很 危险 。 


九 、 动 作 模 式 的 安全 防护 


1. 手动 模式 下 的 安全 
在 手动 减速 模式 下 ， 机 事 人 只 能 减速 (250mm/s 或 更 慢 ) 操作 (移动 )。 只 要 在 安全 保 
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护 空 间 之 内 工作 ， 就 应 始终 以 手动 速度 进行 操作 。 

手动 全 速 模式 下 ， 机 大 人 以 程序 预 设 速度 移动 。 手 动 全 速 模式 应 用 仅 用 于 所 有 人 员 都 位 
于 安全 保护 空间 之 外 时 ， 而 且 操作 人 员 必 须 经 过 特 丈 培训， 熟知 沫 在 的 危险 。 

2. 自动 模式 下 的 安全 

目 动 模式 用 于 在 生产 中 运行 机 融 人 程序 。 在 目 动 模式 操作 情况 下 ， 笛 规模 式 停止 〈GS ) 
机 制 、 上 自动 模式 停止 (AS) 机 制 和 上 级 停止 《SS) 机 制 都 将 处 于 活动 状态 。 


十 、 灭 火 


发 生火 灾 时 ， 请 确保 全 体 人 员 安 全 撤离 后 再 行 灰 火 。 应 首先 处 理 有 党 伤 人 员 。 当 电气 设备 
(例如 机 器 人 或 控制 器 ) 起 火 时 ， 使 用 二 氧化 碳 灭火 峰 ， 切 幻 使 用 水 或 泡沫 。 


第 一 病 _ 机 此 人 干涉 


汪 六 六 六 六 六 六 人 六 信人 信人 从 公信 人 六 信人 六 信人 六 人 人 六 人 人 闪闪 全 全 全 
全 人 $- 人 -人 -人 人 人 AAA 























在 自动 化 生产 线 上 ， 机 器 人 工作 站 越 来 越 被 广泛 应 用 。 尤 其 在 汽车 的 装 烛 线 上 ， 多 台 机 
器 人 在 同一 个 工作 站 中 协同 工作 ， 形 成 多 台 机 器 人 的 焊接 系统 。 工 作 站 中 的 机 器 人 在 共同 执 
行 革 种 作业 任务 时 ， 必 然 要 与 作业 环境 中 另外 的 机 器 人 形成 动态 障碍 关系 。 

机 器 人 在 作业 过 程 中 ,或 者 在 运行 过 程 中 ， 两 个 或 两 个 以 上 的 零件 (或 部 件 ) 同时 占 
有 同一 位 置 而 发 生 冲突 称 为 干涉 。 通 常情 况 下 多 个 机 器 人 的 工作 空间 存在 重叠 交 又 区 域 ， 机 
械 人 各 关节 之 间 在 运动 过 程 中 极 易 产生 机 械 干涉 ， 导 致 生产 事故 的 发 生 ， 影 响 了 整 条 生产 线 
的 生产 ， 因 此 多 机 器 人 之 间 的 动态 干涉 问题 亟待 解决 。 

机 器 人 之 间 干 涉 会 引起 机 器 人 自身 的 部 件 损坏 、 机 器 人 的 程序 混乱 、 加 工 中 的 工件 损 
坏 、 周 边 其 他 设备 设施 的 损坏 。 因 此 解决 机 器 人 的 干涉 问题 尤为 重要 。 

针对 机 器 人 的 干涉 情况 首先 需要 分 析 机 器 人 的 干 干涉 区 
涉 区 。 干涉 区 如 图 10-3 所 示 ， 就 是 各 机 器 人 因 作 业 需 
要 ， 共 同 经 由 或 滞留 的 空间 。 同 一 工 位 的 机 器 人 ， 在 
工作 过 程 中 ,需要 进入 到 同一 个 区 域 , 但 进入 的 先后 
次 序 无 严格 的 限定 ， 任 意 一 台 机 器 人 先进 入 ， 在 工艺 
上 都 允许 〈 除 了 影响 运行 时 间 外 ) 。 人 允许 使 用 干涉 区 
过 号 控制 机 器 人 运行 ， 防 止 机 器 人 之 间 碰 撞 。 

确认 好 干涉 区 范围 之 后 ,将 机 器 人 各 自在 进入 干 
涉 区 之 前 设置 等 待 动 作 ， 并 且 必 须 确认 等 待 中 的 机 只 式 售 ) 
人 是 否 完全 处 于 干涉 区 之 外 。 

不 同 的 干涉 区 使 用 不 同 的 干涉 信和 号: 如 果 两 台 机 
器 人 之 间 存 在 多 个 干涉 区 ， 则 要 求 使 用 不 同 的 干涉 区 
信号。 图 10-3 ”机 器 人 的 干涉 区 

对 于 有 严格 的 工艺 时 序 的 干涉 ， 采 用 互 锁 信号 来 控制 。 互 锁 信 号 是 针对 机 器 人 需要 在 干 
涉 区 工作 的 时 间 而 设置 的 ， 即 针对 双方 作业 干涉 区 进行 机 器 人 干涉 信和 号 设置 ， 保 证 在 同一 时 
间 段 内 ， 相 互 可 能 干涉 的 机 器 人 只 允许 有 一 台 进 入 该 区 域 ， 其 他 的 需要 等 待 干涉 区 空 后 再 进 









































人， 
设置 干涉 区 的 控制 信号 必然 影响 生产 线 的 生产 效率 ， 因 此 在 设置 干涉 区 信号 时 应 从 下 面 
儿 个 方面 考虑 。 


一 、 在 高 效 完成 作业 的 前 提 下 设置 干涉 


由 于 干涉 区 的 存在 ， 造 成 机 器 人 单独 作业 ， 从 而 发 生 降低 生产 效率 的 现象 。 因 此 在 设 轩 
干涉 区 的 时 候 ， 必 须根 据 各 机 器 人 的 作业 量 以 及 作业 顺序 ， 设 置 最 合理 、 最 有 效 的 干涉 区 作 
业 步 又 。 

如 图 104 所 示 ， 机 器 人 A 的 作业 为 4 个 点 ， 机 器 人 忆 
的 作业 为 5 个 点 ， 因 此 机 器 人 了 的 作业 在 无 干涉 的 情况 下 必 
然 慢 于 机 器 人 A。 如 此 在 干涉 区 中 进行 作业 时 ， 如 果 以 原本 
慢 的 机 器 人 B 等 待机 器 人 A 的 形式 进行 作业 ,机 器 人 B 完成 (^) (a) 
作业 的 时 间 将 会 更 长 ， 因 此 影响 到 生产 效率 。 所 以 设置 干涉 
的 时 候 要 以 机 器 人 B 先 作 业 的 形式 进行 生产 。 值 得 注意 的 是 。 图 104 机 器 人 干涉 区 
工作 站 每 一 项 工作 的 完成 是 以 所 有 参加 工作 的 机 器 人 动作 停止 为 结 点 的 。 


二 、 作 业 中 所 有 可 能 发 生 干 涉 的 干涉 区 都 要 设置 信号 


图 10-5 所 示 为 工作 站 的 A、B 两 台 
焊接 机 各 人 的 工作 区 域 的 干涉 区 ， 不 难 
发 现 ， 如 采 机 带 人 A 在 打 干 涉 区 中 心 、 
点 的 时 候 ， 机 器 人 B 在 打 干 涉 区 外 心 、 
避 点 的 情况 下 ,干涉 区 或 许 会 被 巧妙 错 


过 。 


但 此 时 如 果 机 右 人 A 由 于 未 知 原因 
突然 停止 在 干涉 区 中 ， 而 机 器 人 有 因为 
没有 接收 到 任何 信号 而 持续 打点 的 话 ， 
那 双 方 会 发 生 碰撞 事故 。 

因此 为 避免 上 述 情况 的 发 生 ， 在 非 
直接 干涉 的 干涉 区 存在 的 情况 下 ， 也 要 
设置 干涉 信号 ， 作 为 保护 措施 。 

干涉 区 域 不 一 定 仪 仅 存 在 于 两 台 机 
器 人 之 间 ， 周 边 还 有 其 他 机 器 人 的 情况 
下 ， 所 有 的 因 动 作 组 合 而 存在 的 干涉 区 ， : 
部 需要 进行 确认 与 设置 。 图 10-5 “焊接 机 器 人 工作 区 域 的 干涉 区 


三 、 进 入 发 出 OFF 信号 ， 脱 离 发 出 ON 信和 号 


在 图 10-5 所 示 的 焊接 机 豆 人 工作 站 中 ， 假 设 机 需 人 A 信号 设置 为 进入 发 出 ON 信和 号 ， 


























AN 工业 机 器 人 技术 应 用 


脱离 发 出 OFF 信号 的 形式 ， 那 么 机 人 右 人 A 在 干涉 区 中 作业 时 ， 突 然 发 生 断 电 ， 或 其 他 原因 
造成 该 机 逢 人 的 信号 关 财 ， 都 会 导致 机 带 人 B 接收 到 OFF 的 信号 ， 从 而 进入 干涉 区 造成 机 
信人 的 碰撞 等 事故 。 

如 宋 机 做 人 A 信号 设置 为 进入 发 出 OFF 信号 ， 脱 离 发 出 ON 信号 的 形式 ， 那 么 就 算 发 
生 以 上 的 断 电 等 事故 ， 机 各 人 B 由 于 接收 不 到 ON 的 信号 ， 于 是 一 直 等 待 ， 从 而 避免 事故 的 
发 生 。 








四 、 两 台 机 器 人 之 间 的 互 锁 


在 图 10-6 弧 烛 机 人 各 人 工作 站 中 ，A 机 硕 人 为 焊接 机 融 人 ， 在 工作 人 台 位 置 进行 工件 焊接 ， 
B 为 搬运 机 需 人 ， 两 台 机 需 人 在 工作 人 台 位 置 处 存在 干涉 现象 。 















图 10-6 弧 焊 机 器 人 工作 站 


工作 站 工作 时 序 : 焊接 机 般 人 A 在 干涉 区 外 等 待 进行 焊接 ， 搬 运 机 需 人 B 先 将 工件 搬 
运 至 竺 焊接 的 工 位 上 上， 搬运 机 需 人 离开 干涉 区 域 后 ， 焊 接 机 希 人 A 进入 开始 焊接 ， 焊 接 完 
成 后 ， 焊 接 机 侣 人 A 离开 干涉 区 域 ， 工 作 台 夹具 打开 ， 搬 运 机 盏 人 B 才能 进行 搬运 。 当 扳 
运 机 各 人 B 搬运 工件 离开 干涉 区 后 ， 此 工作 站 的 干涉 互 锁 设置 才 算 完成 。 


第 三 避 电磁 于 拢 
由 于 电磁 干扰 、 射 频 干 扰 和 静电 放电 ， 使 机 器 人 及 其 系统 和 周边 设备 产生 误 动作 ， 意 外 
启动 或 控制 失效 会 形成 各 种 危险 运动 。 因 此 针对 机 器 人 的 抗 电磁 、 静 电影 响 的 考虑 尤为 重 
要 。 
一 、 静 电影 响 
ESD (静电 放电 ) 是 电动 势 不 同 的 两 个 物体 间 的 静电 传导 ， 它 可 以 通过 直接 接触 传导 ， 





第 十 章 工业 机 器 人 的 安全 防护 “人 


也 可 以 通过 感应 电场 传导 。 通 过 摩 探 〈 摩 探 静 电 ) 和 静电 感应 可 以 产生 高 达 几 千 伏 的 静电 
电压 ， 最 常见 的 产生 静电 的 方式 是 摩擦 。 合 成 纤维 辅 之 以 干燥 的 空气 尤其 会 助长 这 种 静电 效 
应 ， 两 种 介 电 帝 数 不 同 的 材料 相互 摩擦 也 会 产生 静电 。 经 过 摩 控 ， 材 料 将 被 充 上 电荷 ， 即 一 
种 材料 将 电子 放 给 了 为 一 种 材料 ， 其 表现 形式 是 出 现 一 种 极 性 单一 的 带电 粒子 堆积 现象 。 这 
种 现象 在 人 体 上 同样 也 可 以 发 生 。 例 如 ， 一 个 人 在 干燥 环境 中 穿 了 一 双 绝 缘 性 能 恨 好 的 鞋 在 
人 工 合成 材料 制 的 地 毯 行走 ， 由 此 他 可 以 带 上 高 达 15kV 的 静电 ,这 一 电压 的 极 小 部 分 (人 
察觉 不 到 ) 已 经 足以 摧毁 静电 保护 事件 〈ESD) 。 与 通过 静电 而 产生 的 电压 相 比 ， 现 代 半 结 
体 元 件 的 耐 压 性 能 简直 是 微乎其微 。 此 外 ，ESD 不 仅 会 导致 部 件 的 完全 损坏 ， 有 时 它 还 可 能 
部 分 地 损坏 集成 电路 (1C) 或 者 元 件 ， 其 结果 是 导致 使 用 寿命 下 降 ， 或 者 在 目前 还 正常 的 
部 件 上 引起 间 发 性 故障 。 

在 操作 所 有 安装 在 机 融 人 控制 柜 内 的 组 件 时 ， 必 须 章 守 静 电 保 护 准 则 。 这 些 组 件 都 装配 
有 高 级 的 模块 并 且 对 毅 电 放电 很 敏感 。 

搬运 部 件 或 其 容 帮 时 ， 未 接地 的 人 员 也 可 能 会 传导 大 量 的 静电 入。 一 旦 放电 可 能 会 损坏 
灵敏 的 电子 装置 。 排 除 静 电 危 险 应 按照 表 10-4 操作 。 

表 10-4 排除 静电 操作 


























序号 操作 作用 
1 使 用 手腕 带 手腕 带 必须 经 常 检查， 以 确保 没有 损坏 ， 并 且 要 正确 使 用 
2 | 。 使 用 ESD 保护 地 执 ”| 地热 必须 通过 限 流 电阻 接地 
3 使 用 防 静电 和 桌 执 此 热 应 能 控制 静电 放电 且 必 须 接地 
二 、 电 磁 干扰 


电磁 干扰 的 传播 途径 主要 是 通过 空间 辐射 或 者 导线 传导 ， 即 辐射 发 射 和 传导 发 射 ， 以 及 
感应 耦合 。 形 成 电磁 干扰 〈EMI) 必须 具备 电磁 干扰 源 、 电 磁 干 扰 途 径 、 对 电磁 干扰 敏感 的 
系统 三 个 有 要素。 在 工业 机 般 人 系统 中 的 电动 机 多 采用 交流 伺服 系统 ， 其 包含 开关 型 功率 电力 
电子 帮 件 和 高 速 电 子 电 路 ， 由 电力 电子 旧 件 的 开关 产生 的 电磁 波 辐 射出 去 可 导致 周围 设备 运 
行 异 常 。 从 男 一 方面 来 讲 ， 交 流 电 网 中 存在 大 量 的 谐 波 干扰 ， 交 流 伺服 系统 的 供电 电源 也 会 
受到 来 自 被 污染 的 交流 电网 的 干扰 ， 寿 不 加 以 处 理 ， 电 网 电磁 干扰 就 会 通过 电网 电源 电路 干 
扰 交 流 伺服 系统 ， 或 者 伺服 放大 需 附 近 安 闭 了 很 多 噪声 源 ， 如 电磁 接触 硕 、 电 磁 制 动 硕 、 多 
个 继 电 融 等 ， 也 会 使 伺服 放大 天 运行 异常 。 在 机 天 人 系统 中 ， 设 备 被 安置 在 一 个 相对 聚集 的 
空间 中 ， 各 个 电气 元 件 之 间 的 电磁 干扰 相对 明显 。 因 此 ， 电 磁 干 扰 对 系统 的 影响 不 可 忽视 。 


三 、 降 低 电磁 干扰 的 措施 


解决 电磁 干扰 问题 ， 是 提高 机 融 人 运动 精确 度 的 重要 措施 。 控 制 系统 的 抗 干扰 能 力 关系 
到 整个 系统 的 可 对 性 ， 而 系统 的 可 做 性 则 直接 影响 企业 的 生产 效率 以 及 设备 的 安全 和 经 济 运 
行 。 

根据 电磁 干扰 的 不 同 传播 途径 ， 可 以 采用 隔离 、 滤 波 、 屏 散 、 接 地 等 多 种 方法 抑制 电磁 
干扰 。 
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(一 ) 从 伺服 放大 器 辐射 出 的 引起 周围 机 器 运行 异常 的 电磁 干扰 的 抗 干扰 措施 

伺服 放大 禹 产生 的 电磁 干扰 是 由 于 伺服 放大 豆 本 体 和 输入 、 和 输出 连接 的 电线 辐射 出 去 
的 ， 对 笔 近 主 电路 电线 周围 设备 的 信号 线 有 电磁 感应 和 静电 感应 。 

采取 的 抗 干扰 措施 为 : 将 易 受 干扰 的 闭 置 尽量 远离 伺服 放大 需 ， 僻 服 放大 融 的 动力 线 
(输入 、 输 出 电缆 ) 和 信号 线 应 避免 平行 布线 或 束 状 布线 ， 应 尽量 分 开 布线 。 编 码 肯 的 连接 
电缆 和 信号 控制 线 应 使 用 屏蔽 双 绞 线 ， 屏 殴 线 的 外 层 要 与 接地 端子 连接 。 伺服 放 大 上 右 和 伺服 
电动 机 应 采用 一 点 接地 。 接 地 线 必须 短 而 粗 ， 使 得 接地 电阻 和 电感 较 小 ， 免 得 引入 额外 的 干 
扰 。 接 地 线 与 大 地 要 连接 良好 ， 并 将 信号 线 与 动力 线 分别 放 在 金属 线 槽 中 。 

(二 ) 对 外 部 进入 伺服 放大 器 并 导致 其 运行 异常 的 电磁 干扰 的 抗 干扰 措施 

在 干扰 源 设备 上 安装 浪 涌 吸 收 帮 以 抑制 干扰 。 在 信号 线 上 ， 安 装 数据 线 滤 波 副 。 通 过 电 
缆 卡 头 将 编码 器 连接 线 和 信号 控制 线 接 地 。 

(三 ) 控制 柜 的 安装 位 置 

在 自动 化 生产 线 上 的 工业 机 各 人 工作 站 中 ， 不 再 是 一 台 、 两 台 机 帮 人 协同 工作 ， 而 是 多 
台 机 需 人 布局 在 一 个 特定 的 空间 。 因 此 ， 多 个 机 釉 人 控制 柜 的 安装 位 置 除了 考虑 场地 使 用 、 
操作 者 操作 方便 以 外 ， 一 个 重要 的 因素 是 要 考虑 控制 柜 之 间 的 合理 布局 ， 这 是 消除 电磁 干 
扰 、 快 速 散热 、 提 升 机 需 人 运动 准确 性 的 重要 因素 。 




















机 敌人 应 用 从 传统 制造 业 回 非 制造 业 转 变 ， 回 以 人 为 中 心 的 个 人 化 和 微型 化 方 癌 发 展 ， 
并 将 服务 于 人 类 活动 的 各 个 领域 。 总 趋势 是 从 狭义 的 机 和 右 人 概念 各 广义 的 机 各 人 技术 ( RT) 





概念 转移 ;从 工业 机 带 人 产业 向 解决 工程 应 用 方案 业务 的 机 和 融 人 技术 产业 发 展 。 机 个 人 技术 
(RT) 的 内 涵 已 变 为 “灵活 应 用 机 需 人 技术 的 、 具 有 实在 动作 功能 的 智能 化 系统 ”。 

目前 ， 工 业 机 豆 人 技术 正在 向 智能 机 融和 智能 系统 的 方 问 发 展 ， 其 发 展 趋势 主要 为 : 结 
构 的 模块 化 和 可 重 构 化 ; 控制 技术 的 开放 化 、PC 化 和 网 络 化 ; 伺服 驱动 技术 的 数字 化 和 分 
散 化 ; 多 传 感 表 融合 技术 的 实用 化 ; 工作 环境 设计 的 优化 和 作业 的 对 性 化 以 及 系统 的 网 络 化 
和 智能 化 等 方面 。 


第 一 卫 _ 机 描 人 的 最 新 发 展 


一 、 机 器 人 操作 机 


通过 有 限 元 分 析 、 模 态 分 析 及 仿真 设计 等 现代 设计 方法 的 运用 ， 机 釉 人 操作 机 已 实现 了 
优化 设计 。 以 德国 KUKA 公司 为 代表 的 机 融 人 公司 ,已 将 机 副 人 并 联 平行 四 边 形 结 构 改 为 
开 链 结构 ， 拓 展 了 机 从 人 的 工作 范围 ， 加 之 轻 质 铝 合金 材料 的 应 用 ， 大 大 提高 了 机 右 人 的 
性 能 。 此 外 采用 先进 的 RV 减速 禹 及 交流 伺服 电动 机 ， 使 机 峰 人 操作 机 几乎 成 为 免 维护 系 
统 ; 


二 、 并 联机 器 人 


采用 并 联机 构 ， 利 用 机 器 人 技术 ， 实 现 高 精度 测量 及 加 工 ， 这 是 机 器 人 技术 向 数控 技术 
的 拓展 ， 为 将 来 实现 机 器 人 和 数控 技术 一 体 化 商定 了 基础 。 意 大 利 COMAU 公司 、 日 本 
FANUC 公司 等 已 开发 出 了 此 类 产品 。 


三 、 控 制 系统 


控制 系统 的 性 能 进一步 提高 ,已 由 过 去 控制 标准 的 6 轴 机 侣 人 发 展 到 现在 能 够 控制 21 
轴 甚 至 27 轴 ， 并 且 实 现 了 软件 伺服 和 全 数字 控制 。 人 机 界面 更 加 友好 ， 基 于 图 形 操 作 的 界 
面 也 已 问世。 编程 方式 仍 以 示 教 编程 为 主 ， 但 在 某 些 领域 的 离线 编程 已 实现 实用 化 。 
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四 、 传 感 系统 


激光 传 感 带 、 视 觉 传 感 副 和 力 传 感 右 在 机 器 人 系统 中 已 得 到 成 功 应 用 ， 并 实现 了 焊 缝 上 自 
动 跟踪 和 目 动 化 生产 线 上 物体 的 自动 定位 以 及 精密 装配 作业 等 ， 大 大 提高 了 机 响 人 的 作业 性 
能 和 对 环境 的 适应 性 。 日 本 KAWASAKI、YASKAWA 、FANUC 和 瑞典 ABB 、 德 国 KUKA、 
REIS 等 公司 皆 推 出 了 此 类 产品 。 








五 、 网 络 通信 功能 


日 本 YASKAWA 和 德国 KUKA 公司 的 最 新 机 器 人 控制 项 已 实现 了 与 Canbus 、Profipus 总 
线 及 一 些 网 络 的 连接 ， 使 机 需 人 由 过 去 的 独立 应 用 辐 网 络 化 应 用 迈进 了 一 大 步 ， 也 使 机 器 人 
由 过 去 的 专用 设备 向 标准 化 设备 发 展 。 


入、 可 靠 性 


由 于 微 电 子 技术 的 快速 发 展 和 大 规模 集成 电路 的 应 用 ， 使 机 做 人 系统 的 可 靠 性 有 了 很 大 
提高 。 过 去 机 磊 人 系统 的 可 徘 性 MTBF 一 般 为 几 千 小 时 ， 而 现在 已 达到 5 万 hn， 几乎 可 以 满 
足 任何 场合 的 需求 。 
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一 、 智 能 机 器 人 的 发 展现 状 


智能 机 各 人 是 第 三 代 机 各 人 ， 这 种 机 人 右 人 带 有 多 种 传 感 融 ， 能 够 将 多 种 传 感 带 得 到 的 信 
上 县 进行 融合 ， 能 够 有 效 地 适应 变化 的 环境 ， 具 有 很 强 的 目 适 应 能 力 、 学 习 能 力 和 目 治 功能 。 
目前 研制 中 的 智能 机 天 人 智能 水 平 并 不 高 ， 只 能 说 是 智能 机 夫人 的 初级 阶段 。 在 智能 机 
俘 人 研究 中 ， 当 前 的 核心 问题 有 两 方面 : 一 方面 是 提高 智能 机 大 人 的 自主 性 ， 这 是 就 智能 机 
船 人 与 人 的 关系 而 言 ， 即 布 望 智 能 机 替 人 进一步 独立 于 人 ， 具 有 更 为 友善 的 人 机 界面 。 从 长 
远 来 说 ， 和 硕 望 操作 人 员 只 要 给 出 要 完成 的 任务 ， 机 融 能 目 动 形成 完成 该 任务 的 步 又 ， 并 有 目 动 
完成 它 。 另 一 方面 是 提高 智能 机 需 人 的 适应 性 ， 提 高 智能 机 需 人 运 应 环境 变化 的 能 力 ， 这 是 
网 智能 机 琅 人 与 环境 的 关系 而 言 ， 乔 望 加 强 它们 之 间 的 交互 关系 。 

镶 能 机 天 人 涉及 许多 关键 技术 ， 这 些 技术 关系 到 智能 机 融 人 智能 性 的 高 低 。 这 些 关 键 技 
术 主 要 有 以 下 几 个 方面 : 多 传 感 信息 融合 技术 ， 多 传 感 表 信息 融合 观 是 指 综合 来 自 多 个 传 感 
全 的 感知 数据 ， 以 产生 更 可 靠 、 更 准确 或 更 全 面 的 信息 ， 经 过 融合 的 多 传 感 带 系统 能 够 更 加 
完善 、 精 确 地 反映 检测 对 象 的 特性 ， 消 除 信息 的 不 确定 性 ， 提 高 信息 的 可 靠 性 ;， 导航 和 定位 
技术 ,在 日 主 移动 机 副 人 导航 中 ， 无 论 是 局 部 实时 避 障 还 是 全 局 规划 ， 虱 需要 精确 知道 机 检 
人 或 障碍 物 的 当前 状态 及 位 置 ， 以 完成 导航 、 避 障 及 路 径 规划 等 任务 ， 路 径 规 划 技 术 ， 最 优 
路 径 规 划 就 是 依据 茶 个 或 菜 些 优化 准则 ， 在 机 需 人 工作 空间 中 找到 一 条 从 起 始 状态 到 目标 状 
态 、 可 以 避 开 障碍 物 的 最 优 路 径 ; 机 融 人 视觉 技术 ， 机 各 人 视觉 系统 的 工作 包括 图 像 的 获 





























取 ， 图 像 的 处 理 和 分 析 、 输 出 和 显示 ， 核 心 任务 是 特征 提取 ， 图 像 分 割 和 图 像 辨 识 ; 智能 控 
制 拉 术 ,智能 控制 方法 提高 了 机 和 侣 人 的 速度 及 精度 ; 人 机 接口 技术 ， 人 机 接口 搁 术 是 人 研究 如 
何 使 人 方便 、 上 自然 地 与 计算 机 交流 。 

在 各 国 的 智能 机 帮 人 发 展 中 ， 美 国 的 智能 机 各 人 技术 在 国际 上 一 直人 处 于 领 完 地 位 ， 其 技 
术 人 全面、 先进， 适应 性 也 很 强 ， 性 能 可 靠 、 功 能 全 面 、 精 确 度 高 ， 其 视觉 、 触 觉 等 人 工 智 能 
技术 已 在 航天 、 汽 车 工业 中 广泛 应 用 。 日 本 由 于 一 系列 扶植 政策 ， 各 类 机 带 人 包括 智能 机 楷 
人 的 发 展 迅 速 。 欧 洲 各 国 在 智能 机 各 人 的 研究 和 应 用 方面 在 世界 上 也 处 于 公认 的 领先 地 位 。 
中 国 起 步 较 晚 ， 而 后 进入 了 大 力 发 展 的 时 期 ， 期望 以 机 右 人 为 媒介 物 推 动 整个 制造 业 的 改 
变 ， 推 动 整个 高 新 技术 产业 的 壮大 。 


二 、 智 能 机 器 人 的 应 用 


现代 智能 机 需 人 基本 能 按 人 的 指令 完成 各 种 复杂 的 工作 ， 如 座 海 探 测 、 作 战 、 侦 察 、 搜 
集 情报 、 抢 险 、 服 务 等 工作 ， 模 拟 完 成 人 类 不 能 或 不 愿 完 成 的 任务 ， 不 仅 能 自主 完成 工作 ， 
而 且 能 与 人 共同 协作 完成 任务 或 在 人 的 指 
导 下 完成 任务 ， 在 不 同 领域 有 着 广泛 的 应 
败 & 

智能 机 器 人 按照 工作 场所 的 不 同 ， 可 
以 分 为 管道 机 融 人 、 水 下 机 需 人 、 空 中 机 
顺 人 、 地 面 机 需 人 等 。 

管道 机 器 人 可 以 用 来 检测 管 关 使 用 过 
程 中 的 破裂 、 腐 蚀 和 焊 颖 质量 情况 ， 在 恶 
劣 环境 下 承担 管道 的 清扫 、 噶 涂 、 焊 接 、 
内 部 抛光 等 维护 工作 ， 对 地 下 管道 进行 修 | BE , 
复 。 图 11-1 水 下 机 器 人 

图 11-1 所 示 的 水 下 机 需 人 ， 可 以 用 于 
进行 海洋 科学 研究 、 海 上 石油 开发 、 海 底 矿 藏 勘探 、 海 底 打 搞 救 生 等 ; 美国 的 AUSS、 俄 罗 
斯 的 MT-88 、 法 国 的 EPAVLARD 等 水 下 机 需 人 已 用 于 海洋 石油 开采 ， 海 底 勘 查 、 救 护 作 业 、 
管道 歼 设 和 检查 、 电 费 甫 设 和 维护 以 及 大 坝 检 查 等 方面 ， 形 成 了 有 缆 水 下 机 需 人 (Remote 
Operated Vehicle) 和 无 缆 水 下 机 需 
人 (Autonomous Under Water Vehicle ) 










































空中 机 器 人 可 以 用 于 通信 、 
象 、 灾 害 监测 、 农 业 、 地 质 、 交 
通 、 广 播 电 视 等 方面 ， 一 直 是 先进 “A : Ei 
机 器 人 的 重要 研究 领域 。 目 前 关 、 -RS ES 区 、 
俄 、 加 拿 大 等 国 已 研制 出 各 种 空中 轩 = 和 是 
机 器 人 。 如 图 11-2 所 示 的 空中 机 器 。 ~ 
人 、 美 国 NASA 的 空中 机 器 人 图 11.2 空中 机 器 人 
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Sojanor 等 。Sojanor 是 一 辆 自主 移动 车 ， 质 量 为 11.5kg， 尺寸 630mm x48mm， 有 6 个 车 轮 ， 
它 在 火星 上 的 成 功 应 用 ， 引 起 了 全 球 的 广泛 关注 。 

在 核 工 业 方面 ， 国 外 的 人 研究 主要 集中 在 机 构 灵 巧 、 动 作 准 确 可 徘 、 反 应 快 、 质 量 轻 、 刚 
度 好 、 便 于 装 代 与 维修 的 高 性 能 伺服 手 ， 以 及 半 自 主 和 自主 移动 机 器 人 ， 如 图 11-3 所 示 的 
核 工 业 机 器 人 。 已 完成 的 典型 系统 有 美国 ORML 基于 机 器 人 的 放射 性 储 龟 清 理 系统 、 反 应 
堆 用 双 臂 操作 各 ， 加 拿 大 研制 成 功 的 辐射 监测 与 故障 诊断 系统 ， 德 国 的 C7 灵巧 手 等 。 

地 下 机 右 人 主要 包括 采掘 机 需 人 和 地 下 管道 检修 机 器 人 两 大 类 ， 图 114 所 示 的 为 一 款 
地 下 机 器 人 。 对 此 类 机 器 人 的 主要 研究 内 容 为 : 机 械 结 构 、 行 走 系统 、 传 感 器 及 定位 系统 、 
控制 系统 、 通 信 及 遥控 技术 。 目 前 日 、 美 、 德 等 发 达 国 家 已 研制 出 了 地 下 管道 和 石油 、 天 然 
气 等 大 型 管道 检修 用 的 机 句 人 ， 各 种 采掘 机 器 人 及 上 自动 化 系统 正在 研制 中 。 











图 11-3 核 工 业 机 器 人 图 11-4 地 下 机 器 人 





微型 机 器 人 以 纳米 技术 为 基础 在 生物 工程 、 医 学 工程 、 微 型 机 电 系 统 、 光 学 、 超 精密 加 
工 及 测量 (如 扫描 隧道 显微镜 ) 等 方面 具有 广阔 的 应 用 前 景 。 在 医学 方面 ， 医 用 机 器 人 的 主 
要 研究 内 容 包括 : 医疗 外 科 手 术 的 规划 与 仿真 、 机 器 人 辅助 外 科 手 术 、 最 小 损伤 外 科 、 临 场 
感 外 科 手 术 等 。 美 国 已 开展 临场 感 外 科 (Telepresence Surgery) 的 研究 ， 用 于 战场 模拟 、 手 
术 培 训 、 解 剖 教 学 等 。 法 、 英 、 意 、 德 等 国家 联合 开展 了 图 像 引导 型 矫形 外 科 (Telematics ) 
计划 、 袖 珍 机 器 人 (Biomed) 计划 以 及 用 于 外 科 手 术 的 机 电 手 术 工 具 等 项 目的 研究 ， 并 已 
取得 一 些 卓有成效 的 结果 。 图 11-5 所 示 为 日 
本 草 津 的 立 命 馆 大 学 研究 人 员 展 示 超 小 医用 
机 右 人 的 模型 。 这 种 直径 1cm、 长 为 2cm、 重 
仅 为 5g 的 医用 机 器 人 可 以 到 达 人 体内 患 病 
处 ， 并 能 与 其 他 医疗 器 械 配 套 使 用 。 

在 建筑 方面 ， 有 高 层 建 筑 抹 灰 机 器 人 、 
预制 件 安装 机 器 人 、 室 内 装修 机 器 人 、 擦 玻 
璃 机 器 人 、 地 面 抛光 机 器 人 等 ， 并 已 实际 应 
用 ， 图 11-6 所 示 的 为 一 款 建筑 机 器 人 正 攀 缘 
在 墙壁 上 。 美 国 卡耐基 梅 隆 大 学 、 麻 省 理工 图 115 医用 机 带 信 
































学 院 等 都 在 进行 管道 挖 气 和 埋设 机 侣 人 、 内 增 安 冯 机 胡 人 等 型 号 的 研制 ， 并 开展 了 传 感 带 、 
移动 技术 和 系统 目 动 化 施工 方法 等 基础 研究 。 英 、 德 、 法 等 国 也 在 开展 这 方面 的 研究 。 

在 国防 领域 中 ， 军 用 智能 机 需 人 得 到 前 所 未 有 的 重视 和 发 展 。 近 年 来 ， 美 、 瑞 等 国人 研制 
出 第 二 代 军 用 智能 机 需 人 ， 其 特点 是 采用 目 主 控制 方式 ， 能 完成 侦察 、 作 战 和 后 勤 文 援 等 任 
务 ， 在 战场 上 具有 看 、 串 等 能 力 ， 能 够 自动 跟 踊 地 形 和 选择 道路 ， 具 有 自动 搜索 、 识 别 和 消 
灭 政 方 目标 的 功能 ， 如 美国 的 Navplab 自主 导航 车 、SSV 自主 地 面 战 车 、 法 国 的 自主 式 快速 
运动 侦察 车 (DARDS) 、 德 国 MV4 爆炸 物 处 理 机 需 人 等 。 目 前 美国 ORNL 正在 人 研制 和 开发 
Abrams 坦 区 、 爱 国 者 导弹 装 电池 用 机 天 人 等 各 种 用 途 的 军用 机 天 人 。 

在 未 来 的 军事 智能 机 天 人 中 ， 还 会 有 智能 战斗 机 种 人 、 智 能 侦察 机 天 人 、 智 能 警戒 机 天 
人 、 智 能 工兵 机 豆 人 、 智 能 运输 机 做 人 等 ， 成 为 国防 装备 中 新 的 沈 点 ， 如 图 11-7 所 示 的 一 
丈 盏 用 机 辞 人 。 




















图 11-6 建筑 机 器 人 图 11-7 军用 机 器 人 











服务 机 天 人 可 半 目 主 或 全 目 主 工作 ， 为 人 类 提供 服务 ， 其 中 医用 机 做 人 具有 民 好 的 应 用 
前 景 ; 仿 人 机 和 侣 人 的 形状 与 人 类 似 ， 具 有 移动 功能 、 操 作 功 能 、 感 知 功能 、 记 忆 和 上 自治 能 
力 ， 能 够 实现 人 机 交互 。 

在 服务 工作 方面 ， 世 界 各 国 尤其 是 西方 发 达 国 家 都 在 致力 于 人 研究 开发 和 广泛 应 用 服务 智 
能 机 需 人 。 以 清 尘 机 需 人 为 例 ， 随 痢 科 学 技术 的 进步 和 社会 的 发 展 ， 人 们 和 硕 望 更 多 地 从 烦琐 
的 日 党 事务 中 解脱 出 来 ， 这 就 使 得 清洁 机 符 人 进入 家 庭 成 为 可 能 。 日 本 公司 研制 的 地 面 清扫 
机 和 个人， 可 沿 墙 壁 从 任何 一 个 位 置 自动 启动 ， 利 用 不 断 旗 2 
转 的 刷子 将 废弃 物 扫 入 目 带 容 肯 中 ; 车 站 地 面 擦洗 机 带 人 
工作 时 一 面 将 清洗 液 喷 洒 到 地 面 上 ， 一 面 用 旋转 刷 不 停 地 
擦洗 地 面 ， 并 将 脏 水 吸入 所 带 的 容 各 中 ; 工厂 的 自动 清扫 
机 各 人 可 用 于 各 种 工厂 的 清扫 工作 。 如 图 11-8 所 示 ， 美 国 
的 一 球 清 洁 机 各 人 “Roomba” 具 有 口 度 上 自主 能 力 ， 可 以 游 
走 于 房间 各 家 具 缝 际 间 ， 灵 巧 地 完成 清扫 工作 。 珊 典 的 一 
球 机 各 人 “三 叶 虫 ”， 表面 光 滑 ， 呈 圆 形 ， 内 置 搜 索 雷 达 ， 
可 以 迅速 地 探测 到 并 避 开 桌 腿 、 玻 璃 右上 、 宠 物 或 任何 其 
他 障碍 物 。 一 旦 微 处 理 带 识别 出 这 些 障碍 物 ， 它 可 重新 选 























图 11-8 Roomba 机 器 人 
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择 路 线 ， 并 对 整个 房间 做 出 重新 判断 与 计算 ， 以 保证 房间 的 各 个 角落 都 被 清扫 。 

甚至 在 体育 比赛 方面 ， 机 需 人 也 得 到 了 很 大 的 发 展 。 近 年 来 在 国际 上 迅速 开展 起 来 足球 
机 人 硕 人 与 机 需 人 足球 高 技术 对 抗 活动 ， 国 际 上 已 成 立 相 关 的 联合 会 FIRA， 许 多 地 区 也 成 立 
了 地 区 协会 ， 已 达到 比较 正规 的 程度 且 有 相当 的 规模 和 水 平 。 机 融 人 足球 赛 的 目的 是 将 足球 
(高 尔 夫 球 ) 撞 入 对 方 球门 取胜 。 球场 上 空 (2m) 高 悬挂 的 摄像 机 将 比赛 情况 传人 计算 机 
内 ， 由 预 汛 的 软件 做 出 恰当 的 决 岳 与 对 策 ， 通 过 无 线 通 信和 方式 将 指挥 命令 传 给 机 右 人 。 机 可 
人 协同 作 威 ， 双 方 对 抗 ， 形 成 一 场 激烈 的 足球 比赛 。 在 比赛 过 程 中 ， 机 天 人 可 以 随时 更 新 它 
的 位 置 。 每 当 它 穿 过 地 面 线 截面 ， 双 方 的 教练 员 与 系统 开发 人 员 不 得 进行 干预 。 机 右 人 足球 
技术 融 计 算 机 视觉 、 模 式 识别 、 决 策 对 策 、 无 线 数字 通信 、 目 动 控 制 与 最 优 控制 、 智 能 体 设 
计 与 电力 传动 等 技术 于 一 体 ， 是 一 个 典型 的 智能 机 带 人 系统 。 

现代 智能 机 此 人 不 仅 在 上 述 方面 有 广泛 应 用 ， 而 是 渗透 到 生活 的 各 个 方面 。 像 在 煤炭 工 
业 ， 在 矿业 方面 ， 考 虑 到 社会 上 对 煤 妈 需 求 量 日 益 增 长 的 趋势 和 煤 恢 开采 的 恶劣 环境 ， 将 智 
能 机 希 人 应 用 于 矿业 势 在 必 行 。 随 痢 智 能 机 需 人 应 用 领域 的 日 益 扩 大 ， 人 们 期 望 智能 机 硕 人 
能 在 更 多 的 领域 为 人 类 服务 ， 人 代替 人 类 完成 更 多 、 更 复杂 的 工作 。 可 以 预见 ， 在 21 世纪 各 
种 先进 的 机 人 各 人 系统 将 会 进入 人 类 生活 的 各 个 领域 ， 成 为 人 类 良好 的 助手 和 亲密 的 伙伴 。 


三 、 智 能 机 器 人 的 发 展 趋势 


智能 机 硕 人 具有 广阔 的 发 展 前 景 ， 目 前 机 硕 人 的 研究 正 处 于 第 三 代 知 能 机 和 需 人 阶段 ， 尽 
管 国内 外 对 此 的 研究 已 经 取得 了 许多 成 果 ， 但 其 智能 化 水 平 仍然 不 尽 人 意 。 未 来 的 智能 机 带 
人 应 当 在 以 下 儿 方 面 着 力 发 展 : 面向 任务 ， 由 于 目前 人 工 智 能 还 不 能 提供 实现 智能 机 各 的 完 
整理 论 和 方法 ， 已 有 的 人 工 智能 技术 大 多 数 要 依赖 领域 知识 ， 因 此 当 把 机 需要 完成 的 任务 加 
以 限定 ， 即 发 展 面向 任务 的 特种 机 需 人 ,那么 已 有 的 人 工 智能 技术 就 能 发 挥 作用 ， 使 开发 这 
种 类 型 的 智能 机 徐 人 成 为 可 能 ; 传 感 技术 和 集成 技术 ， 在 现 有 传 感 带 的 基础 上 发 展 更 好 、 更 
先进 的 处 理 方 法 和 实现 手段 ， 或 者 寻找 新 型 传 感 夯 ， 同 时 提高 集成 技术 ， 增 加 信息 的 融合 ; 
机 各 人 网 络 化 ， 利 用 通信 网 络 拉 术 将 各 种 机 右 人 连接 到 计算 机 网 络 上 ， 并 通过 网 络 对 机 磊 人 
进行 有 效 的 控制 ; 智能 控制 中 的 软 计算 方法 ， 与 传统 的 计算 方法 相 比 ， 以 模糊 逻辑 、 基 于 概 
率 论 的 推理 、 神 经 网 络 、 遗 传 算法 和 混沌 为 代表 的 软 计算 技术 具有 更 高 的 鲁 棒 性 、 易 用 性 及 
计算 的 低 耗费 性 等 优点 ， 应 用 到 机 各 人 技术 中 ， 可 以 提高 其 问题 求解 速度 ， 较 好 地 处 理 多 变 
量 、 非 线性 系统 的 问题 ; 机 需 学 习 ， 各 种 机 融 学 习 算法 的 出 现 推动 了 人 工 智 能 的 发 展 ， 强 化 
学 习 、 习 群 算法 、 免 疫 算法 等 可 以 用 到 机 从 人 系统 中 ， 使 其 具有 类 似 人 的 学 习 能 力 ， 以 适应 
日 益 复 茶 的 、 不 确定 和 非 结 构 化 的 环境 ; 智能 人 机 接口 ， 人 机 交互 的 需求 越 来 越 癌 简单 化 、 
多 样 化 、 智 能 化 、 人 性 化 方向 发 展 ， 因 此 需要 研究 并 设计 各 种 智能 人 机 接口 ， 如 多 语种 语 
音 、 上 自然 语言 理解 、 图 像 、 手 写字 识别 等 ， 以 更 好 地 适应 不 同 的 用 户 和 不 同 的 应 用 任务 ， 提 
高 人 与 机 大 人 交互 的 和 谐 性 ; 多 机 需 人 协调 作业 、 组 织 和 控制 多 个 机 天 人 来 协作 完成 单机 天 
人 无 法 完成 的 复杂 任务 ， 在 复杂 未 知 环境 下 实现 实时 推理 反应 以 及 交互 的 群体 决策 和 操作 。 

由 于 现 有 的 智能 机 天 人 的 智能 水 平 还 不 够 高 ， 因 此 在 今后 的 发 展 中 ， 努 力 提 高 各 方面 的 
技术 及 其 综合 应 用 ， 大 力 提高 智能 机 做 人 的 智能 程度 ， 提 高 智能 机 天 人 的 目 主 性 和 适应 性 ， 
是 智能 机 右 人 发 展 的 关键 。 同 时 ， 智 能 机 各 人 涉及 多 个 学 科 的 协同 工作 ,不 仪 包括 技术 基 





















































第 十 一 章 工业 机 器 人 的 发展 站 势 “人 





础 ， 甚 至 还 包括 心理 学 、 伦 理学 等 社会 科学 ， 让 智能 机 需 人 完成 有 益 于 人 类 的 工作 ， 使 人 类 
从 繁重 、 重 复 、 和 危险 的 工作 中 解脱 出 来 ， 就 像 科 约 作 家 阿 西 莫 夫 的 “机 上 秀 人 学 三 大 法 则 ” 
一 样 ， 让 智能 机 各 人 真正 为 人 类 利益 服务 ， 而 不 能 成 为 反 人 类 的 工具 。 相 信 在 不 远 的 将 来 ， 
各 行 各 业 痢 会 充满 形形色色 的 智能 机 带 人 ， 科 幻 小 说 中 的 场景 将 在 科学 家 们 的 努力 下 逐步 成 
为 现实 ， 很 好 地 提高 人 类 的 生活 品质 和 对 未 知事 物 的 探索 能 力 。 

我 国 的 智能 机 夫 人 发 展 还 落后 于 世界 先进 水 平 ， 而 智能 机 夫 人 又 是 高 科技 的 集中 体现 ， 
有 具有 重要 的 发 展 价值 ， 因 此 我 国 在 智能 机 大 人 领域 要 认 清 形势 、 明 确 发 展 目标 ， 采 取 符 合 我 
国 国 情 的 可 行 发 展 对 策 ， 努 力 缩小 与 世界 领先 水 平 的 差距 ， 早 日 让 智能 机 带 人 全 面 为 社会 的 
发 展 服务 。 相 信和 经 过 政府 的 重视 和 投入 ,科技 工作 者 的 不 懈 奋 斗 ， 我 国 的 智能 机 人 右 人 发 展 水 
平 能 达到 新 的 高 度 。 

















第 三 节 网 络 机 人 费 人 技术 


六 六 -六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 六 全 六 六 六 六 六 六 盖 六 人 全 六 
人 人 -人 信人 人 人 人 -人 AAA 


一 、 基 于 网 络 的 遥 操 作 技术 


遥 操 作 系 统 允许 操作 者 通过 主 从 机 各 人 来 实现 对 远程 设备 的 控制 。 它 主要 应 用 于 空间 技 
术 、 核 废料 的 处 理 、 显 微 外 科 、 微 电子 装配 、 水 下 操作 、 采 矿业 及 消防 救援 等 方面 。 

远 操作 系统 包括 操作 者 、 主 设备 、 通 信 通 道 、 从 机 带 人 和 和 远 闻 环境。 主机 紫 人 设备 核心 
是 力 反馈 操纵 杆 ， 而 从 机 右 人 可 为 任意 类 型 的 设备 。 设 计 并 安装 于 机 右 人 上 的 双 工 控制 带 负 
责 主 从 设备 间 的 双向 信息 流传 输 。 通 信 媒 介 可 采用 因特网 或 无 线 技术 。 总 体 来 说 ， 双 工控 制 
骨 要 被 设计 为 稳定 上 且 透 明 的 系统 。 所 谓 透 明 系统 是 一 种 理想 情况 ， 即 操作 者 目 吴 感觉 不 到 主 
从 设备 之 间距 离 的 存在 ， 操 作者 的 感觉 就 如 同 对 远程 环境 中 的 设备 进行 本 地 直接 操作 。 当 从 
机 敌人 设备 上 的 位 置 和 力 的 变化 可 与 反馈 给 操作 者 的 位 置 和 力 的 变化 相 匹配 时 ， 上 述 透 明 系 
统 在 技术 上 是 可 实现 的 。 然 而 ， 由 于 通信 中 的 时 潍 和 系统 中 存在 的 噪声 及 系统 自身 存在 的 不 
稳定 因 系 ， 使 实现 稳定 上 且 透 明 的 双 工 系统 操作 仍 有 困难 。 因 此 ， 设 计 在 系统 存在 显著 通信 延 
玉环 境 下 的 双 工 控制 器 更 具 实际 意义 。 而 且 设计 具有 自 适应 性 的 双 工 控制 器 是 一 种 可 行 的 方 
法 。 

基于 网 络 的 机 副 人 技术 被 提出 后 ， 首 先 被 应 用 到 遥 操 作 领 域 。 如 Mercury Robot，Telero- 
bot 及 Telegerden 等 都 是 给 用 户 提供 通过 因特网 对 远程 设备 实施 遥 操 作 控 制 的 机 需 人 。 这 些 
系统 在 初期 只 能 提供 机 带 人 工作 环境 的 静止 画面 ， 有 些 系统 如 Telegerden 也 尝试 使 用 CAD 
技术 来 回馈 被 控 机 械 辟 状态 动画 。 当 支持 通过 网 络 传 输 流 式 图 像 数 据 的 网 络 摄像 头 技术 出 现 
后 ,现场 环境 的 图 像 反 馈 变 得 易于 实现 。 

要 使 用 户 能 远程 控制 机 带 人 并 完成 一 系列 复杂 动作 ， 就 需要 使 用 更 先进 的 技术 来 实现 复 
杂 且 友好 的 用 户 界面 。 在 这 些 工作 中 ， 马 修 R. 斯 坦 ( MattheW R，Stein) 的 网 络 交 互 绘画 
机 各 人 Puma Paint Project 十 分 引 人 注 目 。 它 允许 任意 因特网 用 户 通 过 网 络 控 制 PUMA760 机 
械 臂 在 远程 实验 室 画布 上 完成 绘画 操作 。 用 户 界面 提供 了 用 Java 设计 的 虚拟 画布 ， 并 且 系 
统 通过 不 断 的 图 像 更 新 给 用 户 提 供 及 时 的 视觉 反馈 , 使 得 没有 任何 专业 知识 的 网 络 用 户 也 可 
轻松 实施 操作 。 
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根据 控制 系统 性 能 和 技术 的 先进 性 , 遥 操 作 机 人 各 人 控制 技术 人 研究 现状 与 发 展 可 分 为 如 下 
几 个 阶段 : 

(一 ) 手工 闭环 控制 

这 是 了 最早 且 研究 最 多 的 一 种 遥 操 作 形 式 ， 其 中 操作 者 是 手动 财 环 控制 的 核心 部 分 。 这 一 
早期 的 遥 操 作 技术 主要 应 用 于 在 危险 环境 下 进行 操作 的 设备 中 ， 如 核 工 业 设备 ， 水 下 遥控 操 
作 设 备 和 空间 设备 。 但 通信 的 明显 沛 后 、 不 稳定 性 和 手动 财 环 控制 是 其 主要 缺点 。 

(二 ) 共享 或 监管 控制 

这 种 控制 机 制 的 目的 是 使 机 融 人 或 设备 的 控制 可 由 本 地 控制 回路 和 远程 遥控 操作 者 来 共 
享 。 本 地 控制 回路 负责 其 基本 功能 的 实现 ， 远 程 遥 挖 操作 者 主要 负责 系统 的 监控 及 对 异常 情 
况 的 处 理 。 这 一 技术 提高 了 操作 者 对 设备 的 可 操作 性 ， 避 人 免 了 系统 不 稳定 性 问题 。 但 昂贵 
的 、 为 单一 目的 建设 的 操作 站 是 其 致命 的 缺点 。 通 信 的 专用 性 也 限制 了 普通 网 络 用 户 的 访 
问 , 使 得 这 一 技术 只 能 应 用 于 固定 的 专业 领域 中 。 

(三 ) 基于 万 维 网 的 遥 操 作 机 器 人 

万 维 网 台 控 机 如 人 这 一 概念 还 处 于 锥 形 阶段 。 它 通过 基于 因特网 的 Web 浏览 右 来 控制 
远程 机 带 人 和 设备 。 这 就 需要 先进 的 网 络 监 控 机 制 来 避免 系统 的 不 稳定 并 文 持 网 络 多 用 户 访 
问 。 这 一 技术 的 提出 开创 了 一 个 加 新 的 研究 领域 ,使 运 操 作 技 术 的 应 用 走 癌 网 络 化 和 全 球 
化 。 





























二 、 基 于 网 络 的 自主 移动 机 器 人 控制 技术 


使 用 万 维 网 作为 机 融 人 远程 控制 的 基础 构架 使 得 在 仪 使 用 标准 HTML 接口 的 情况 下 给 
网 络 用 户 提 供 访 问 变 得 易于 实施 。 因 此 可 应 用 网 络 搁 术 进 一 步 扩 展 上 自主 移动 机 人 带 人 的 控制 手 
段 ,， 使 其 控制 不 再 受 空间 和 地 域 的 限制 。 国 外 在 这 一 领域 已 经 开展 了 深入 人 研究， 如 卡耐基 梅 
隆 大 学 研发 的 基于 Web 的 办 公 室 自主 移动 机 右 人 Xavier 和 基于 网 络 进行 远程 控制 的 博物 馆 
导游 机 此 人 米 勒 娃 ( Minerva) 。 这 些 机 天 人 的 特点 是 自身 具有 较 高 和 目 主 性 ， 而 网 络 技术 又 给 
异地 操作 者 提供 了 进行 远程 控制 的 手段 。 基 于 网 络 的 室内 自主 机 大 人 控制 采用 事件 驱动 和 任 
务 控 制 的 系统 体系 结构 时 , 其 自主 性 和 基于 网 络 的 远程 控制 会 得 到 更 完美 的 结合 。 

最 初 基于 网 络 的 移动 机 天 人 的 上 自主 性 能 有 限 ， 而 且 同 一 时 间 内 只 能 向 单一 用 户 提 供 网 络 
服务 。 瑞 士 联邦 洛桑 科技 研究 所 的 Khepon The Web 就 是 其 中 典型 代表 。 用 户 可 通过 网 络 控 
制 小 型 移动 机 絮 人 在 人 造 迷宫 中 进行 运动 并 能 同时 经 摄像 头 的 图 像 反 馈 进行 观 察 。 

Carnegie Mellon 大 学 人 研发 的 Xaiver 是 第 一 个 可 通过 网 络 控 制 并 运行 于 复杂 办 公 环 境 的 日 
主 移动 机 右 人 。 机 各 人 可 在 线 或 离线 接收 请 求 命令 并 在 运行 时 段 内 进行 处 理 。Xaiver 完成 任 
务 后 会 通过 电子 邮件 通知 用 户 。Xaiver 的 网 络 界面 使 用 了 Client-pull 和 Server-push 技术 来 获 
取 图 像 。 此 外 Xaiver 的 用 户 界 面 还 提供 办 公 环 境 的 地 图 并 显示 机 帮 人 在 其 上 的 位 置 。 

在 更 为 复杂 的 动态 环境 ( 如 博物 馆 ) 中 ， 机 需 人 在 执行 任务 时 会 遇 到 大 量 不 可 预见 事 
件 。 例 如 ,博物馆 导 游 机 右 人 米 勒 娃 除 了 要 对 网 络 用 户 进 行 在 线 响 应 ， 同 时 还 要 与 博物 馆 中 
的 游客 进行 现场 人 机 交互 ， 所 以 其 任务 规划 要 能 够 处 理 各 种 不 可 预测 的 突 发 事件 。 博 物 馆 导 
游 机 侣 人 要 及 时 问 用 户 提供 各 种 反馈 。 由 于 使 用 了 基于 Java Applet 的 技术 ， 其 在 低 市 宽 情 
况 下 仍 能 按 要 求 更 新 机 人 融 人 状态 。 网 络 用 户 界面 还 提供 机 右 人 所 带 摄 像 涉 和 安装 于 天 花 板 上 
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摄像 头 所 传 回 的 图 像 。 使 用 多 种 方式 的 代理 技术 可 文 持 多 用 户 同时 访问 。 实 际 应 用 中 党 要求 
网 络 用 户 同 现场 用 户 分 享 机 需 人 的 控制 。 网 络 能 给 异地 用 户 提 供 远 程 现场 再 现 ， 而 现场 用 户 则 
通过 比 网 络 更 直接 的 方式 控制 机 项 人 ， 这 就 要 求 混合 控制 的 界面 设计 要 避免 两 者 相互 干扰 。 

提高 被 控 机 硕 人 的 目 主 性 对 实现 实时 远程 控制 具有 重要 意义 。 被 控 机 符 人 本 吴 具 有 的 避 
障 功 能 ， 对 路 径 的 自主 规划 和 对 多 任务 的 决策 能 力 ， 部 有 利于 减少 网 络 通信 中 不 可 预测 时 沛 
对 机 天 人 控制 实时 性 的 影响 。 这 一 思想 的 实质 是 将 属于 远程 控制 的 部 分 功能 下 放 到 控制 系统 
本 地 来 实现 ， 远 程 的 操作 者 只 需 对 预先 定义 好 的 操作 指令 实施 控制 操作 ， 或 直接 通过 对 运行 
于 客户 端的 辅助 软件 的 图 形 界 面 及 命令 菜单 的 单 击 来 实施 远程 操作 控制 。 这 一 方法 降低 了 系 
统 的 复杂 度 ， 将 各 种 简单 的 基本 操作 集成 为 高 层次 的 复合 动作 ， 从 而 提高 了 系统 操作 的 集成 
度 ， 加 快 了 系统 的 控制 响应 速度 ， 保 证 了 控制 的 实时 性 。 

通过 上 述 技术 手段 的 应 用 ， 当 网 络 通信 出 现 拥 窗 而 导致 传输 速率 下 降 时 ， 机 各 人 控制 系 
统 本 号 应 能 够 相应 降低 控制 精度 ， 和 暂缓 非 紧急 任务 ， 从 而 降低 网 络 通 信 的 负载 。 如 果 出 现 系 
统 暂 时 的 通信 中 汤 ， 控 制 系统 的 自主 性 可 避免 机 带 人 处 于 失控 状态 ,使 其 仍 能 正常 完成 底层 
控制 功能 ， 并 可 根据 前 一 时 间 段 中 存储 的 远程 控制 信息 进行 智能 预测 ， 自 主 地 继续 完成 操作 
者 的 控制 要 求 。 


三 、 分 布 式 机 器 人 控制 系统 


基于 因特网 的 远程 遥控 机 绥 人 技术 的 应 用 使 得 低 价 、 灵 活 、 可 扩展 的 真正 分 布 式 系统 得 
以 在 机 如 人 领域 实现 。 任 何 连 接 到 因特网 上 的 机 各 人 、 代 理 设备 、 现 场 设备 相 互 间 均 可 进行 
通信 和 交互 操作 ， 以 共同 完成 远程 任务 。 在 美国 航空 航天 管理 局 的 寻 路 者 计划 (Pathfinder 
Mission) 中 就 采用 了 这 一 技术 。 这 使 得 科学 家 们 不 必 集 中 到 加 利 福 尼 亚 的 控制 中 心 也 可 在 
世界 各 地 通过 因特网 交互 系统 来 相互 合作 ， 实 施 对 寻 路 者 计划 中 空间 设备 的 控制 。 这 一 应 用 
是 通过 因特网 实施 分 布 式 控制 的 成 功 实例 。 

构建 高 性 能 的 通信 协议 体系 是 实现 多 个 用 户 和 代理 间 协 作 控 制 的 前 提 。 由 于 协议 在 整个 
系统 中 必须 具有 通用 性 ， 这 也 使 得 实施 这 一 协议 的 系统 应 具有 可 重用 的 软件 架构 。 在 网 络 体 
系 结构 中 ， 同 位 体 是 指 任何 与 另 一 个 实体 处 在 同一 层次 上 的 功能 单元 或 操作 装置 。 分 布 式 系 
统 架 构 允 许多 个 同位 体 通 过 中 央 路 由 融 进 行 互 联 ， 如 图 11-9 所 示 。 同 位 体 还 可 通过 具有 可 





















































图 11-9 同位 体 到 路 由 融 的 体系 结构 


NN 工业 机 器 人 技术 应 用 


选择 性 的 通信 “频道 ”进行 报 文 交换 。 路 由 融 除 了 知道 报 文 的 目的 地 址 和 通信 “频道 ”外 ， 
无 须 了 解 报 文 中 具体 内 容 。 

当 分 布 式 系统 中 包含 机 项 人 设备 时 ， 通 常 被 定义 为 分 布 式 机 句 人 系统 。 不 同 的 分 布 式 机 
顺 人 系统 使 用 不 同 的 通信 协议 和 技术 ， 如 可 应 用 CORBA 、RMI 或 MOM 等 中 间 件 技术 来 实 
现 其 分 布 性 。 中 间 件 是 为 特定 用 户 的 需要 而 剪裁 的 系统 软件 。 下 面 介 绍 一 下 基于 网 络 的 分 布 
式 机 器 人 系统 中 名 用 的 几 种 中 间 件 技术 。 

( 一) CORBA (Common Object Reguest Broker Architecture ) 

CORBA 规范 是 由 OMG 〈 国 际 对 象 管理 组 织 ) 发 布 并 制定 的 标准 。 它 使 用 ORB (对 象 
请 求 代 理 ) 作为 中 间 件 来 建立 两 个 对 象 间 的 客户 /服务 顺 关 系 。 它 是 面向 对 象 的 远 端 程序 调 
用 (RPC) 的 扩展 。 使 用 ORB ， 客 户 可 在 本 机 或 通过 网 络 透 明 地 调用 服务 顺 程 序 。ORB 截 
取 请 求 并 负责 寻找 可 完成 请 求 的 对 象 ， 并 负责 传递 参数 、 调 用 程序 和 返回 结果 。 客 户 端 不 必 
知道 对 象 所 在 位 置 、 使 用 何 种 编程 语言 和 操作 系统 以 及 任何 与 对 象 接口 无 关 的 系统 信息 。 

(二 ) RMI (Remote Method Invocation ) 

RMI (远程 程序 调用 ) 是 Java 特制 的 RPC 中 间 件 ， 它 给 使 用 Java 对 象 的 分 布 计算 提供 
了 一 种 简单 直接 的 模型 。 这 一 简单 性 是 建立 在 将 所 有 通信 均 限 制 在 仅 应 用 Java 对 象 上 。RMI 
使 用 了 与 CORBA 的 ORB 相似 的 概念 来 提供 远程 对 象 的 查询 和 调用 。RMI 的 优越 性 在 于 它 仅 
适用 于 纯 Java 应 用 ， 整 个 对 象 〈 而 不 仅仅 是 数据 ) 能 在 客户 和 服务 硕 间 传送 ， 从 而 保证 了 
面 癌 对象 的 多 态 性 。 

(三 ) MOM (Message-Oriented Middleware ) 

MOM (面向 报 文 的 中 间 件 ) 与 CORBA 和 RMI 不 同 ， 它 不 是 工业 标准 ， 而 是 在 分 布 式 
应 用 环境 中 文 持 特 定 种 类 通用 目标 报 文 交 换 的 中 间 件 的 集成 术语 。MOM 数据 的 交换 是 通过 
报 文 传输 或 报 文 队 列 ， 并 支持 分 布 式 计算 进程 间 的 同步 或 异步 交互 。MOM 系统 使 用 可 靠 队 
列 来 确保 报 文 传送 ， 并 对 所 支持 的 报 文 提供 目录 检索 、 安 全 及 管理 等 服务 。 队 列 特别 适用 于 
那些 逐步 递 进 的 进程 。MOM 模型 中 的 报 文 是 基于 事件 驱动 的 系统 ， 而 不 仅仅 是 简单 程序 调 
用 。 客 户 可 应 用 具有 优先 级 机 制 的 队列 ， 这 使 得 高 优先 级 的 报 文 可 超越 不 重要 的 报 文 ， 这 对 
分 布 式 机 项 人 的 多 任务 控制 十 分 重要 。 

通过 比较 可 发 现 不 同 的 中 间 件 技术 的 通信 机 理 和 应 用 范围 不 尽 相 同 。 由 于 MOM 支持 的 
是 报 文 格式 ， 因 此 它 主 要 适用 于 有 延迟 的 异步 通信 ; 而 RMI 和 CORBA 均 基 于 RPC (远程 过 
程 调用 ) 语义 ， 是 设计 用 以 文 持 同 步 通信 的 。 此 外 基于 报 文 的 通信 人 允许 向 多 个 同位 体 广播 
信息 。 虽 然 RMI 受到 所 有 基于 其 上 的 应 用 必须 是 用 Java 编写 的 限制 ,但 RMI 也 和 CORBA 
一 样 是 通用 标准 ， 所 以 具有 巨大 的 互联 潜力 。 由 于 第 三 方 利 益 和 版 本 的 不 同 ，RMI 和 COR- 
BA 目前 并 没有 得 到 现 有 浏览 硕 的 广泛 文 持 。 与 之 比较 ，MOM 可 提供 般 入 于 应 用 程序 中 的 轻 
型 客户 端 应 用 编程 接口 ， 而 且 由 于 MOM 不 存在 同步 通信 ， 也 不 需要 预 装 任何 先决 软件 ， 所 
以 它 在 简单 环境 中 更 具有 应 用 潜力 。 但 在 复杂 且 需 要 进行 同步 通信 的 环境 中 ，CORBA 和 
RMI 则 应 给 予 优先 考虑 。 

基于 网 络 的 机 希 人 控制 技术 的 研发 核心 是 实时 远程 控制 的 实现 。 为 克服 网 络 的 不 可 预测 
时 汪 ， 达 到 对 被 控 机 带 人 实施 实时 控制 的 要 求 ， 可 将 通信 构建 在 实时 TCP/AIP 通信 平台 之 
上 。 国 外 已 有 基于 这 一 先进 技术 的 产品 ， 其 技术 原理 是 在 传统 TCPYAIP 协议 的 基础 上 ， 对 开 
放 式 网 络 互 联 的 七 层 通信 结构 进行 精简 与 优化 。 此 外 在 新 因特网 协议 IPV6 中 有 预 留 的 SVP 
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协议 ， 其 文 持 视 党 图 像 数 据 流 的 实时 高 速 传输 ， 这 都 有 利于 虚拟 远程 现场 撤 术 的 实现 。 研 发 
中 还 可 从 控制 软件 的 构架 上 实现 对 控制 任务 的 规划 与 管理 。 由 于 Linux NT 技术 可 实现 对 多 
个 任务 进程 的 管理 ， 并 支持 具有 不 同 优先 级 的 任务 进程 实施 抢占 机 制 ， 这 都 适 于 远程 操作 者 
对 机 大 人 所 遇 到 的 突 发 事件 实施 优先 处 理 。 在 研发 中 还 可 以 考虑 采用 人 带 有 瞬 入 式 模块 的 多 任 
务实 时 操作 系统 来 构建 基于 事件 驱动 和 任务 控制 的 系统 体系 结构 。 

为 实现 实时 控制 ,需要 对 通信 的 数据 进行 预 处 理 。 通 过 网 络 传输 的 数据 主要 分 为 远程 控 
制 信息 和 现场 反馈 信息 。 其 中 现场 反馈 信息 包含 大 量 的 视觉 图 像 数 据 。 图 像 采 集 卡 完成 图 像 
的 数字 化 后 ， 软 件 首 先 要 对 图 像 数 据 进 行 预 处 理 ， 如 进行 图 像 辨 识 与 数据 的 网 络 通信 质量 做 
出 判断 ， 并 相应 地 以 不 同 的 图 像 精度 和 更 新 频率 来 啊 应 控制 端的 请 求 。 

基于 网 络 的 机 磊 人 远程 控制 软件 的 开发 中 涉及 通用 网 关 接 口 (CGI) 和 超 文本 传输 协议 
(HTTP) 等 技术 的 应 用 。CGCI 可 对 客户 端的 请 求 进行 动态 啊 应 ， 而 HTTP 是 一 个 无 状态 的 面 
回 对 象 式 协议 。 但 CCI 和 HTTP 的 技术 组 合 仍 有 局 限 性 ， 使 用 Java 技术 可 以 解决 这 些 问 题 。 
Java 使 客户 端 可 控制 网 络 连接 且 其 用 户 接口 功能 完备 。Java 语言 的 另 一 个 重要 特性 是 其 内 置 
的 多 线程 机 制 。Java 在 系统 级 和 语言 级 均 提 供 了 对 多 线程 的 支持 ， 使 得 Java 具备 了 当代 优 
秀 操作 系统 并 发 处 理事 务 的 能 力 ， 这 样 在 程序 的 运行 中 很 容易 实现 各 功能 模块 之 间 的 切换 协 
作 与 数据 交换 。Java 是 与 平台 无 关 的 ， 它 不 仅 在 源 代码 级 上 实现 了 可 移植 ， 在 二 进 制 代 码 上 
也 实现 了 可 移植 。 
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